Mirror the changes done to cognidrive_ros in the RobotEra svn-repository during the RobotEra meeting in Peccioli, Italy.