Yaw control and more noise suppression

Added a yaw PID controller to further help smooth out the flight.  Added
some features to the low pass filters and implemented more of them
through the roll/yaw control loop.