North to the prize.....

The problem with the new software is a heading issue. The vehicle is supposed to stay pointing north, it wanders as much as 30 degrees. This causes a cross coupling between the E-W Roll and N/S pitch corrections. I still have not figured out why the new software won’t properly hold a precise heading, but I added the full heading coordinate transform to the main flight control loop and it works! On to the next problem….