gsp: Implement custom mixer to handle shifted CG

Since the torque is no longer centered ... the torque we apply or no
longer perfectly aligned with each axis. The mix matrix now has
additional elements filled in.