Add docstrings and code refactor

Add docstrings were for all the functions. Solve bug caused by an
unchecked pointer. Rename functions, variables. Extract duplicate code.
Create new functions in order to have a more readable code.