Added messages to CMakeLists.txt and package.xml

Fixed typo in PlanningEnvironment.msg