Pshh. Still need to implement Kalman filtering (and gyros).