edited Controller Gain section of theory to eliminate references to k_p