V10 Revisions

General code clean up. Changed some movement logic to overcome motor
update delay issues. All omni-directional movements have been enabled.