Motion system is now workable

but not perfect