optimized handling of "FAST" YAW commands
Revert "optimized handling of "FAST" YAW commands"

This reverts commit 3bb78803d9d9dd8c8448c6224ebc9d1b4e5daeb1.
disabling some debug code