Firmware for the Rotary Stewart Platform 6-axis motion control system