TC Main, lift correction

Updated TC Main with Lift Balancing/Correction code.
Cleaned up comments