Added Setup.py for catkin package
State Machine is running, yet to populate the execute methods