Fixed motor output values in config prog.
Added low pass filter to compass to improve calibration and performance.
Added capabilities so that config prof knows what to plot.