Servo command timing fixed! (I think) Plus, motion lists!