Add updated cuberotate ahrs sketch.