2 gyro code

all of the wonderful changes, this is not tested on the field. It was
tested on the bench successfully