Cool example.
Using the Routhian and the constant generalized moment of the angle as a state instead of the generalized velocity, the equations will have another state that is constant. Since the measurement is the angle and not its generalized velocity, the measurement equation will still be linear. Just a thought.
