Updated compass cont calibration test program, added compass to plane test program