Change variable names for clarity.
Modifying Rate FeedForward so that it passes FF completely around the Stabilize PID loops.