Cleaned up RobotUtils include. Added walking test for idynutils. Added test  stub for RobotUtils
Added RobotUtils test.