Added debug output to angular rate controller
Added dead band removal to proportional controller