fix functions with no return statement and other
cppcheck errors fix
Remove self assignment
Merge pull request #7 from pal-robotics/fix_cppcheck

Fix for strict cppcheck and g++ warnings/errors