Cleaned up and restructured the pr2_manipulation_process_module

Old code went into the `graveyard.lisp' file for now. Moved a lot of functions around, removed unused trajectory-related functions (since cram_moveit handles IK data structures now), and added output where appropriate.