GYRO WORKS!!! Also added debugging stuff

The RotateVector function wasn't getting passed to by reference. And the
gyro value wasn't supposed to be multiplied by 4 (idk why I did that).