https://123dok.org/document/dy46gx0z-geometric-attitude-motion-planning-spacecraft-pointing-actuator-constraints.html