N+1 Configuration based control methodology in addition to non-linear kinematics control of TSA was utilized to move the joints. Stay tuned for future work.