Added new TA code
Final calibration for demo
merge in demo final 2 calib
added integral control, tuned some stuff