The Icarus robot assists workers with complex tasks by utilizing sensors to predict task requirements. Todo: Add a service to the robot_driver_node that accomplishes what relax_all.py does now Add a check in IK that deals with impossible points