Step around offset

the same as before but now we fixed the data offset from the gyro.
another step experiment

now at 1.6 rad/s flyingspeed with an stepheight of .12
Add inout plots