New setRobotStatePreGrasp(), setRobotStateGrasp(), and setRobotState() functions

for opening and closing EE

Fixed test launch
Added new test functions