State Machine and Ported Animatics Motor

I implemented a prototype state machine.
I ported the animatics controller from the old code.
More comments! "Write the Stop Command (S)."