Create a mock up state machine that mocks the current fsm and extends to pick and place task. Traffic light example SM should be referred.