Updating PID controller

The PID controller has more descriptive names for its methods and
has fewer member variables.  It also now has an exponential
moving average for the derivative so that it is more resistant to
noise.

Also included in this commit are a few coding-style related fixes
to the YawController.