minor changes to init state
minor changes to states machine actuators for gimbale