Use the gyro sensor more correctly

A bunch of bad assumptions in the old version. Now we're using it to go a little diagonal when we get rotated. We should use it to add some rotation in to our movement such that we straighten out instead.