State Machine and Ported Animatics Motor

I implemented a prototype state machine.
I ported the animatics controller from the old code.
Don't forget to add DEBUG statements!