Cleaning and commenting

include/qrw/FootTrajectoryGenerator.hpp

include/qrw/FootstepPlanner.hpp

include/qrw/StatePlanner.hpp

python/gepadd.cpp

scripts/Controller.py

src/FootTrajectoryGenerator.cpp

src/FootstepPlanner.cpp

src/StatePlanner.cpp