Added a state machine for testing the GrasperNode - GraspT.cc.fsm