implemented ps3 controller
added robot_arm control
tuning in elevator mode