Scissored pair control moment gyroscope inverted pendulum

Work in progress, I have assembled a second gyro cube, so now I can play with a scissored pair CMG. The yaw angle is yet to control, but now it is a software (math) problem, should be doable quite easily.