commenting out reaction plan, pending problem yaw offset, improvements