fix functions with no return statement and others
cppcheck errors
Fix uninitialized
Merge pull request #1 from pal-robotics/hydro-devel

Fix for strict cppcheck and g++ warnings/errors