Separate out rate and delta angle modes.
Use pi from math.
Change prompt to "KVH 1750".
Decrease serial read dt to 0.8 ms.