Initial commit of working FSM driver

Also back and forth script included for alignment