added initial fsm and motor controlers