Got swegway_tetrix to mesh with new PID.
I hate ROBOTC.
(the robot still doesn't quite balance)