Removing test state machine and switching to smach
Do no test with camera
Basics of smach state machine moving through three states controlled by panoptes