Gh cmd angles

Closer to reality horizontal command angles based on forces approximation.