progress

Right. Whith some more work we now have this:this

improved everything. takes in mesurements in mm and spits out movement.

just need to do some acceleration and give it a good test.