added controller code with other trajectory points under arm_controller_2 executable