Updated things so that we can see our stability margin through flight, and
moment is dependent on cg and cp