I have been asked by a few people how SAGAR is going, so I guess I need to do some updates more often. Anyway, SAGAR was shelved for a while. The last tests of the closed loop heading controller showed I had something messing with the compass readings. Further tests concluded that my batteries were biasing my compass.
