Added category 3 and tested on gazebo. Next step, test on robot and maybe create a script to easily set all parameters
Merge pull request #277 from reem-utils/fix_sergi

Added category 3 and tested on gazebo. Next step, test on robot and mayb...