Large trig expressions These all simplify.

expressions.py

from sympy import S


######## small size expression
smallExpr = S('(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q1) - ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q1))*(ddq1*sin(q2)*sin(q3) - ddq2*((-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q1) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q1)) - ddq3*(-(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q2)*cos(q1) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q1)*sin(q2) - sin(q2)*sin(q3)*cos(q2)) - ddq4*((-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))**2 + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))**2 + sin(q2)**2*sin(q3)**2) + dq1*dq2*sin(q3)*cos(q2) + dq1*dq3*sin(q2)*cos(q3) - dq2*(dq1*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q1) + dq1*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q1) - (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q1) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q1)) - dq3*(dq1*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q1)*sin(q2) - dq1*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q2)*cos(q1) - dq2*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q1)*cos(q2) - dq2*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q1)*cos(q2) + dq2*sin(q2)**2*sin(q3) - dq2*sin(q3)*cos(q2)**2 - dq3*sin(q2)*cos(q2)*cos(q3) - (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q1)*sin(q2) - (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q2)*cos(q1)) - dq4*(2*dq2*sin(q2)*sin(q3)**2*cos(q2) + 2*dq3*sin(q2)**2*sin(q3)*cos(q3) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(2*dq1*sin(q1)*sin(q3)*cos(q2) - 2*dq1*cos(q1)*cos(q3) + 2*dq2*sin(q2)*sin(q3)*cos(q1) + 2*dq3*sin(q1)*sin(q3) - 2*dq3*cos(q1)*cos(q2)*cos(q3)) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-2*dq1*sin(q1)*cos(q3) - 2*dq1*sin(q3)*cos(q1)*cos(q2) + 2*dq2*sin(q1)*sin(q2)*sin(q3) - 2*dq3*sin(q1)*cos(q2)*cos(q3) - 2*dq3*sin(q3)*cos(q1)))) + (-(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q1) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q1))*(ddq1*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4)) + ddq2*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q1) - ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q1)) + ddq3*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q2)*cos(q1) - ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q1)*sin(q2) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q2)) + ddq4*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2)) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3)) - (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q2)*sin(q3)) + dq1*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2)) + dq2*(dq1*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q1) + dq1*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q1) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*sin(q1) - (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q1)) + dq3*(dq1*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q1)*sin(q2) - dq1*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q2)*cos(q1) - dq2*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q1)*cos(q2) - dq2*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q1)*cos(q2) - dq2*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q2) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q2) - (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*sin(q2)*cos(q1) - (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*sin(q1)*sin(q2)) + dq4*(-dq2*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q3)*cos(q2) - dq3*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q2)*cos(q3) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3)) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1)) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)) - (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*sin(q2)*sin(q3))) - (dq1*sin(q3)*cos(q2) - dq3*(-(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q1)*cos(q2) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q1)*cos(q2) - sin(q1)**2*sin(q2)**2*sin(q3) - sin(q2)**2*sin(q3)*cos(q1)**2 + sin(q2)**2*sin(q3) - sin(q3)*cos(q2)**2) - dq4*(2*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q2)*sin(q3)*cos(q1) + 2*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q1)*sin(q2)*sin(q3) + 2*sin(q2)*sin(q3)**2*cos(q2)))*(dq1*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4)) + dq2*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q1) - ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q1)) + dq3*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q2)*cos(q1) - ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q1)*sin(q2) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q2)) + dq4*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2)) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3)) - (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q2)*sin(q3))) - (dq1*(-sin(q2)*cos(q4) + sin(q4)*cos(q2)*cos(q3)) + dq2*(-(-sin(q1)*sin(q2)*sin(q4)*cos(q3) - sin(q1)*cos(q2)*cos(q4))*cos(q1) + (-sin(q2)*sin(q4)*cos(q1)*cos(q3) - cos(q1)*cos(q2)*cos(q4))*sin(q1)) + dq3*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q1)*cos(q2) - ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q1)*cos(q2) + (-sin(q2)*cos(q4) + sin(q4)*cos(q2)*cos(q3))*cos(q2) - (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q2) - (-sin(q1)*sin(q2)*sin(q4)*cos(q3) - sin(q1)*cos(q2)*cos(q4))*sin(q1)*sin(q2) - (-sin(q2)*sin(q4)*cos(q1)*cos(q3) - cos(q1)*cos(q2)*cos(q4))*sin(q2)*cos(q1)) + dq4*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q2)*sin(q3)*cos(q1) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q1)*sin(q2)*sin(q3) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-sin(q2)*sin(q4)*cos(q1)*cos(q3) - cos(q1)*cos(q2)*cos(q4)) - (-sin(q2)*cos(q4) + sin(q4)*cos(q2)*cos(q3))*sin(q2)*sin(q3) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-sin(q1)*sin(q2)*sin(q4)*cos(q3) - sin(q1)*cos(q2)*cos(q4)) - (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q3)*cos(q2)))*(dq1*sin(q2)*sin(q3) - dq2*((-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q1) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q1)) - dq3*(-(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q2)*cos(q1) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q1)*sin(q2) - sin(q2)*sin(q3)*cos(q2)) - dq4*((-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))**2 + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))**2 + sin(q2)**2*sin(q3)**2)) + (dq1*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4)) + dq2*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q1) - ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q1)) + dq3*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q2)*cos(q1) - ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q1)*sin(q2) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q2)) + dq4*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2)) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3)) - (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q2)*sin(q3)))*(-dq1*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q1) - dq1*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q1) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q1) - (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q1)) + (dq1*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q1) + dq1*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q1) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*sin(q1) - (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q1))*(dq1*sin(q2)*sin(q3) - dq2*((-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q1) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q1)) - dq3*(-(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q2)*cos(q1) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q1)*sin(q2) - sin(q2)*sin(q3)*cos(q2)) - dq4*((-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))**2 + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))**2 + sin(q2)**2*sin(q3)**2))')



######## medium size expression
mediumExpr = S('(-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4)) - (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4)) - ((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4)))*(ddq1*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4)) + ddq2*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q1) - ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q1)) + ddq3*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q2)*cos(q1) - ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q1)*sin(q2) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q2)) + ddq4*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2)) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3)) - (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q2)*sin(q3)) + ddq5*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))**2 + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))**2 + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))**2) + dq1*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2)) + dq2*(dq1*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q1) + dq1*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q1) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*sin(q1) - (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q1)) + dq3*(dq1*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q1)*sin(q2) - dq1*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q2)*cos(q1) - dq2*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q1)*cos(q2) - dq2*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q1)*cos(q2) - dq2*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q2) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q2) - (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*sin(q2)*cos(q1) - (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*sin(q1)*sin(q2)) + dq4*(-dq2*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q3)*cos(q2) - dq3*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q2)*cos(q3) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3)) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1)) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)) - (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*sin(q2)*sin(q3)) + dq5*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(2*dq1*sin(q1)*sin(q2)*cos(q4) - 2*dq2*cos(q1)*cos(q2)*cos(q4) + 2*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + 2*dq4*sin(q2)*sin(q4)*cos(q1) + 2*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-2*dq1*sin(q2)*cos(q1)*cos(q4) - 2*dq2*sin(q1)*cos(q2)*cos(q4) + 2*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + 2*dq4*sin(q1)*sin(q2)*sin(q4) + 2*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-2*dq2*sin(q2)*cos(q4) + 2*dq2*sin(q4)*cos(q2)*cos(q3) - 2*dq3*sin(q2)*sin(q3)*sin(q4) + 2*dq4*sin(q2)*cos(q3)*cos(q4) - 2*dq4*sin(q4)*cos(q2)))) + (((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(2*dq1*sin(q1)*sin(q2)*cos(q4) - 2*dq2*cos(q1)*cos(q2)*cos(q4) + 2*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + 2*dq4*sin(q2)*sin(q4)*cos(q1) + 2*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-2*dq1*sin(q2)*cos(q1)*cos(q4) - 2*dq2*sin(q1)*cos(q2)*cos(q4) + 2*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + 2*dq4*sin(q1)*sin(q2)*sin(q4) + 2*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-2*dq2*sin(q2)*cos(q4) + 2*dq2*sin(q4)*cos(q2)*cos(q3) - 2*dq3*sin(q2)*sin(q3)*sin(q4) + 2*dq4*sin(q2)*cos(q3)*cos(q4) - 2*dq4*sin(q4)*cos(q2)))*(-dq1*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5)) - dq2*((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q1) - (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q1)) - dq3*(-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q2)*cos(q1) - (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q1)*sin(q2) + ((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q2)) - dq4*((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2)) + (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3)) - ((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q2)*sin(q3)) - dq5*((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4)) + (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4)) + ((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4)))) + (((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))**2 + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))**2 + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))**2)*(-ddq1*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5)) - ddq2*((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q1) - (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q1)) - ddq3*(-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q2)*cos(q1) - (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q1)*sin(q2) + ((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q2)) - ddq4*((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2)) + (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3)) - ((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q2)*sin(q3)) - ddq5*((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4)) + (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4)) + ((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))) - dq1*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5)) - dq2*(dq1*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q1) + dq1*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q1) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q1) - (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*cos(q1)) - dq3*(dq1*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q1)*sin(q2) - dq1*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q2)*cos(q1) - dq2*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q1)*cos(q2) - dq2*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q1)*cos(q2) - dq2*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q2) - (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q2)*cos(q1) - (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q1)*sin(q2) + (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*cos(q2)) - dq4*(-dq2*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q3)*cos(q2) - dq3*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q2)*cos(q3) + (((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*(dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3)) + (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*(-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1)) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5)) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5)) - (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q2)*sin(q3)) - dq5*((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)) + (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5)) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5)) + ((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2)) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5)))) - (-dq1*(-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5)) - dq2*((-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q1) - (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q1)) - dq3*(-(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q2)*cos(q1) - (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q1)*sin(q2) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q2)) - dq4*((-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2)) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3)) - (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q2)*sin(q3)) - dq5*((-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4)) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4)) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))))*(dq1*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4)) + dq2*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q1) - ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q1)) + dq3*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q2)*cos(q1) - ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q1)*sin(q2) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q2)) + dq4*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2)) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3)) - (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q2)*sin(q3)) + dq5*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))**2 + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))**2 + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))**2)) + (dq1*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4)) + dq2*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q1) - ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q1)) + dq3*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q2)*cos(q1) - ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q1)*sin(q2) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q2)) + dq4*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2)) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3)) - (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q2)*sin(q3)) + dq5*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))**2 + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))**2 + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))**2))*(-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)) - (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)) - ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5)) - ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5)) - ((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2)) - (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5)))')



######## large size expression
largeExpr = S('-981*(-sin(q2)*sin(q4)*cos(q3) - cos(q2)*cos(q4))*sin(q6)*cos(q5)/100 + 981*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q6)/100 + (-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2)) - ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3)) + (((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q2)*sin(q3))*(ddq1*((-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 + 39*sin(q1)*sin(q2)*cos(q4)/100 + 2*sin(q1)*sin(q2)/5) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)) + ddq2*(-(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*cos(q1) - (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q1) + (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q1))) + ddq3*((-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q2) - (39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2)) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q2) + (39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1)) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*sin(q2) - (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2)*cos(q1))) + ddq4*((-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3)) + (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2)))*(-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5)) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*((39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*sin(q3) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*sin(q3) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100))) + ddq5*((-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4)) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100))*(-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5)) + ((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4)) - ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100))*(-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5)) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4)) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100))) + dq1*((-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(39*dq1*sin(q2)*cos(q1)*cos(q4)/100 + 2*dq1*sin(q2)*cos(q1)/5 + 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 + 2*dq2*sin(q1)*cos(q2)/5 - 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 - 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 - 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(39*dq1*sin(q1)*sin(q2)*cos(q4)/100 + 2*dq1*sin(q1)*sin(q2)/5 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 - 2*dq2*cos(q1)*cos(q2)/5 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100) + (39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) - dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q5) - (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*sin(q5)) + (-39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 + 39*sin(q1)*sin(q2)*cos(q4)/100 + 2*sin(q1)*sin(q2)/5)*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) - dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) - (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*sin(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*cos(q5))) + dq2*(dq1*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1) - dq1*(-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*cos(q1) - (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-39*dq2*sin(q2)*cos(q4)/100 - 2*dq2*sin(q2)/5 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100)*cos(q1) - (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-39*dq2*sin(q2)*cos(q4)/100 - 2*dq2*sin(q2)/5 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100)*sin(q1) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*(-dq1*(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1) + dq1*(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q1) + (39*dq1*sin(q1)*sin(q2)*cos(q4)/100 + 2*dq1*sin(q1)*sin(q2)/5 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 - 2*dq2*cos(q1)*cos(q2)/5 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)*cos(q1) + (-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 2*dq1*sin(q2)*cos(q1)/5 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 - 2*dq2*sin(q1)*cos(q2)/5 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100)*sin(q1)) + ((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q1) + (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q1))*(-dq2*sin(q3)*cos(q2)*cos(q5) - dq3*sin(q2)*cos(q3)*cos(q5) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) + dq5*sin(q2)*sin(q3)*sin(q5) - (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*sin(q5)) - (39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) - dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) - (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*sin(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*cos(q5))*cos(q1) - (39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) - dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q5) - (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*sin(q5))*sin(q1)) + dq3*((-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-dq1*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1) + dq2*(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2) - dq2*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*cos(q2) - (-39*dq2*sin(q2)*cos(q4)/100 - 2*dq2*sin(q2)/5 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100)*sin(q1)*sin(q2) - (-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 2*dq1*sin(q2)*cos(q1)/5 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 - 2*dq2*sin(q1)*cos(q2)/5 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100)*cos(q2)) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-dq1*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2) - dq2*(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q2) + dq2*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*cos(q1)*cos(q2) + (-39*dq2*sin(q2)*cos(q4)/100 - 2*dq2*sin(q2)/5 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100)*sin(q2)*cos(q1) + (39*dq1*sin(q1)*sin(q2)*cos(q4)/100 + 2*dq1*sin(q1)*sin(q2)/5 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 - 2*dq2*cos(q1)*cos(q2)/5 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)*cos(q2)) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*(dq1*(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q2)*cos(q1) + dq1*(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q1)*sin(q2) + dq2*(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*cos(q2) - dq2*(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q1)*cos(q2) + (39*dq1*sin(q1)*sin(q2)*cos(q4)/100 + 2*dq1*sin(q1)*sin(q2)/5 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 - 2*dq2*cos(q1)*cos(q2)/5 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)*sin(q1)*sin(q2) - (-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 2*dq1*sin(q2)*cos(q1)/5 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 - 2*dq2*sin(q1)*cos(q2)/5 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100)*sin(q2)*cos(q1)) + ((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q2) + (39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1))*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) - dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q5) - (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*sin(q5)) + (-(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q2) - (39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2))*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) - dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) - (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*sin(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*cos(q5)) + ((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*sin(q2) - (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2)*cos(q1))*(-dq2*sin(q3)*cos(q2)*cos(q5) - dq3*sin(q2)*cos(q3)*cos(q5) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) + dq5*sin(q2)*sin(q3)*sin(q5) - (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*sin(q5))) + dq4*((-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3)) + (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2)))*(-dq2*sin(q3)*cos(q2)*cos(q5) - dq3*sin(q2)*cos(q3)*cos(q5) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) + dq5*sin(q2)*sin(q3)*sin(q5) - (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*sin(q5)) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(dq2*(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q3)*cos(q2) + dq3*(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*cos(q3) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*dq2*sin(q2)*cos(q4)/100 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100) + (39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)*(-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1)) + (-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100)*sin(q2)*sin(q3)) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-dq2*(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q3)*cos(q2) - dq3*(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*cos(q3) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*dq2*sin(q2)*cos(q4)/100 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100) - (39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)*(dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3)) - (39*dq1*sin(q1)*sin(q2)*cos(q4)/100 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)*sin(q2)*sin(q3)) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*(-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1)) + (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3)) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(39*dq1*sin(q1)*sin(q2)*cos(q4)/100 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)) + (-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*sin(q3) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100))*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) - dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q5) - (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*sin(q5)) + ((39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*sin(q3) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100))*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) - dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) - (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*sin(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*cos(q5))) + dq5*((-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4)) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100))*(-dq2*sin(q3)*cos(q2)*cos(q5) - dq3*sin(q2)*cos(q3)*cos(q5) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) + dq5*sin(q2)*sin(q3)*sin(q5) - (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*sin(q5)) + ((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4)) - ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100))*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) - dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q5) - (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*sin(q5)) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2)) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-39*dq2*sin(q2)*cos(q4)/100 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100) + (39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)) - (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100)) + (-(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4)) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100))*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) - dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) - (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*sin(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*cos(q5)) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2)) - ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*dq2*sin(q2)*cos(q4)/100 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100) - (39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(39*dq1*sin(q1)*sin(q2)*cos(q4)/100 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*(-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100) + (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)) - ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(39*dq1*sin(q1)*sin(q2)*cos(q4)/100 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)))) + (((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*((39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*sin(q3) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)) + ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*(-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*sin(q3) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)) + (-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3)) + (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2)))*(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)))*(ddq1*(-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5)) + ddq2*((-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q1) - (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q1)) + ddq3*(-(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q2)*cos(q1) - (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q1)*sin(q2) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q2)) + ddq4*((-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2)) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3)) - (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q2)*sin(q3)) + ddq5*((-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4)) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4)) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))) + ddq6*((-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5)) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5)) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5))) + dq1*(-dq2*sin(q3)*cos(q2)*cos(q5) - dq3*sin(q2)*cos(q3)*cos(q5) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) + dq5*sin(q2)*sin(q3)*sin(q5) - (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*sin(q5)) + dq2*(dq1*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q1) + dq1*(-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q1) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) - dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) - (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*sin(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*cos(q5))*sin(q1) - (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) - dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q5) - (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*sin(q5))*cos(q1)) + dq3*(dq1*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q1)*sin(q2) - dq1*(-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q2)*cos(q1) - dq2*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q1)*cos(q2) - dq2*(-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q1)*cos(q2) - dq2*(-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q2) - (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) - dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) - (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*sin(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*cos(q5))*sin(q2)*cos(q1) - (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) - dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q5) - (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*sin(q5))*sin(q1)*sin(q2) + (-dq2*sin(q3)*cos(q2)*cos(q5) - dq3*sin(q2)*cos(q3)*cos(q5) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) + dq5*sin(q2)*sin(q3)*sin(q5) - (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*sin(q5))*cos(q2)) + dq4*(-dq2*(-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q3)*cos(q2) - dq3*(-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q2)*cos(q3) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3)) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1)) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) - dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) - (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*sin(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*cos(q5)) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) - dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q5) - (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*sin(q5)) - (-dq2*sin(q3)*cos(q2)*cos(q5) - dq3*sin(q2)*cos(q3)*cos(q5) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) + dq5*sin(q2)*sin(q3)*sin(q5) - (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*sin(q5))*sin(q2)*sin(q3)) + dq5*((-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) - dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) - (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*sin(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*cos(q5)) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) - dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q5) - (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*sin(q5)) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2)) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-dq2*sin(q3)*cos(q2)*cos(q5) - dq3*sin(q2)*cos(q3)*cos(q5) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) + dq5*sin(q2)*sin(q3)*sin(q5) - (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*sin(q5))) + dq6*((-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*sin(q5) - (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*cos(q5)) + (((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) - dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) - (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*sin(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*cos(q5)) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) - (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*sin(q5)) + (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) - dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q5) - (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*sin(q5)) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*(dq2*sin(q3)*cos(q2)*cos(q5) + dq3*sin(q2)*cos(q3)*cos(q5) + dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - dq5*sin(q2)*sin(q3)*sin(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*sin(q5)) + ((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5))*(-dq2*sin(q3)*cos(q2)*cos(q5) - dq3*sin(q2)*cos(q3)*cos(q5) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) + dq5*sin(q2)*sin(q3)*sin(q5) - (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*sin(q5)))) + ((-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3)) + (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2)))*(-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5)) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*((39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*sin(q3) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*sin(q3) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)))*(-ddq1*(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)) - ddq2*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q1) - ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q1)) - ddq3*(-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q2)*cos(q1) - ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q1)*sin(q2) + (((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q2)) - ddq4*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2)) + ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3)) - (((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q2)*sin(q3)) - ddq5*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4)) + ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4)) + (((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))) - ddq6*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5)) + ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5)) + (((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5))) - dq1*(-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*sin(q6) + (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*cos(q6)) - dq2*(dq1*((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q1) + dq1*((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q1) + (-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*cos(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*sin(q6))*sin(q1) - (-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*cos(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*sin(q6))*cos(q1)) - dq3*(dq1*((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q1)*sin(q2) - dq1*((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q2)*cos(q1) - dq2*((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q1)*cos(q2) - dq2*((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q1)*cos(q2) - dq2*(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q2) - (-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*cos(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*sin(q6))*sin(q2)*cos(q1) - (-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*cos(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*sin(q6))*sin(q1)*sin(q2) + (-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*sin(q6) + (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*cos(q6))*cos(q2)) - dq4*(-dq2*(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q3)*cos(q2) - dq3*(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q2)*cos(q3) + ((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*(dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3)) + ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*(-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1)) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*cos(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*sin(q6)) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*cos(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*sin(q6)) - (-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*sin(q6) + (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*cos(q6))*sin(q2)*sin(q3)) - dq5*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)) + ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)) + (((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2)) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*cos(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*sin(q6)) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*cos(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*sin(q6)) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*sin(q6) + (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*cos(q6))) - dq6*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*(dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*sin(q5) - (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*cos(q5)) + ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*(dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) - (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*sin(q5)) + (((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*cos(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*sin(q6)) + (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*cos(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*sin(q6)) + (((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*(dq2*sin(q3)*cos(q2)*cos(q5) + dq3*sin(q2)*cos(q3)*cos(q5) + dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - dq5*sin(q2)*sin(q3)*sin(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*sin(q5)) + ((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5))*(-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*sin(q6) + (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*cos(q6)))) + ((-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2)) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3)) - (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q2)*sin(q3))*(ddq1*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*(-39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 + 39*sin(q1)*sin(q2)*cos(q4)/100 + 2*sin(q1)*sin(q2)/5) + ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)) + ddq2*(-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*cos(q1) - ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1) + (((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q1) + (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q1))) + ddq3*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*(-(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q2) - (39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2)) + ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q2) + (39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1)) + (((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*sin(q2) - (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2)*cos(q1))) + ddq4*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*((39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*sin(q3) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)) + ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*(-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*sin(q3) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)) + (-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3)) + (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2)))*(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))) + ddq5*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*(-(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4)) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)) + ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4)) - ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)) + (-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4)) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100))*(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))) + dq1*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*(39*dq1*sin(q2)*cos(q1)*cos(q4)/100 + 2*dq1*sin(q2)*cos(q1)/5 + 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 + 2*dq2*sin(q1)*cos(q2)/5 - 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 - 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 - 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100) + ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*(39*dq1*sin(q1)*sin(q2)*cos(q4)/100 + 2*dq1*sin(q1)*sin(q2)/5 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 - 2*dq2*cos(q1)*cos(q2)/5 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100) + (39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*(-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*cos(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*sin(q6)) + (-39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 + 39*sin(q1)*sin(q2)*cos(q4)/100 + 2*sin(q1)*sin(q2)/5)*(-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*cos(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*sin(q6))) + dq2*(dq1*((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1) - dq1*((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*cos(q1) - ((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*(-39*dq2*sin(q2)*cos(q4)/100 - 2*dq2*sin(q2)/5 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100)*cos(q1) - ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*(-39*dq2*sin(q2)*cos(q4)/100 - 2*dq2*sin(q2)/5 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100)*sin(q1) + (((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*(-dq1*(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1) + dq1*(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q1) + (39*dq1*sin(q1)*sin(q2)*cos(q4)/100 + 2*dq1*sin(q1)*sin(q2)/5 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 - 2*dq2*cos(q1)*cos(q2)/5 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)*cos(q1) + (-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 2*dq1*sin(q2)*cos(q1)/5 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 - 2*dq2*sin(q1)*cos(q2)/5 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100)*sin(q1)) + ((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q1) + (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q1))*(-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*sin(q6) + (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*cos(q6)) - (39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*(-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*cos(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*sin(q6))*cos(q1) - (39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*(-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*cos(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*sin(q6))*sin(q1)) + dq3*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*(-dq1*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1) + dq2*(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2) - dq2*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*cos(q2) - (-39*dq2*sin(q2)*cos(q4)/100 - 2*dq2*sin(q2)/5 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100)*sin(q1)*sin(q2) - (-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 2*dq1*sin(q2)*cos(q1)/5 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 - 2*dq2*sin(q1)*cos(q2)/5 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100)*cos(q2)) + ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*(-dq1*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2) - dq2*(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q2) + dq2*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*cos(q1)*cos(q2) + (-39*dq2*sin(q2)*cos(q4)/100 - 2*dq2*sin(q2)/5 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100)*sin(q2)*cos(q1) + (39*dq1*sin(q1)*sin(q2)*cos(q4)/100 + 2*dq1*sin(q1)*sin(q2)/5 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 - 2*dq2*cos(q1)*cos(q2)/5 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)*cos(q2)) + (((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*(dq1*(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q2)*cos(q1) + dq1*(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q1)*sin(q2) + dq2*(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*cos(q2) - dq2*(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q1)*cos(q2) + (39*dq1*sin(q1)*sin(q2)*cos(q4)/100 + 2*dq1*sin(q1)*sin(q2)/5 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 - 2*dq2*cos(q1)*cos(q2)/5 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)*sin(q1)*sin(q2) - (-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 2*dq1*sin(q2)*cos(q1)/5 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 - 2*dq2*sin(q1)*cos(q2)/5 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100)*sin(q2)*cos(q1)) + ((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q2) + (39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1))*(-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*cos(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*sin(q6)) + (-(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q2) - (39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2))*(-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*cos(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*sin(q6)) + ((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*sin(q2) - (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2)*cos(q1))*(-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*sin(q6) + (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*cos(q6))) + dq4*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*(dq2*(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q3)*cos(q2) + dq3*(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*cos(q3) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*dq2*sin(q2)*cos(q4)/100 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100) + (39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)*(-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1)) + (-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100)*sin(q2)*sin(q3)) + ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*(-dq2*(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q3)*cos(q2) - dq3*(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*cos(q3) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*dq2*sin(q2)*cos(q4)/100 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100) - (39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)*(dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3)) - (39*dq1*sin(q1)*sin(q2)*cos(q4)/100 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)*sin(q2)*sin(q3)) + (-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3)) + (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2)))*(-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*sin(q6) + (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*cos(q6)) + (((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*(-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1)) + (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3)) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(39*dq1*sin(q1)*sin(q2)*cos(q4)/100 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)) + (-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*sin(q3) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100))*(-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*cos(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*sin(q6)) + ((39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*sin(q3) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100))*(-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*cos(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*sin(q6))) + dq5*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*(-(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2)) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-39*dq2*sin(q2)*cos(q4)/100 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100) + (39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)) - (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100)) + ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2)) - ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*dq2*sin(q2)*cos(q4)/100 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100) - (39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(39*dq1*sin(q1)*sin(q2)*cos(q4)/100 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)) + (-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4)) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100))*(-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*sin(q6) + (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*cos(q6)) + ((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4)) - ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100))*(-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*cos(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*sin(q6)) + (-(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4)) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100))*(-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*cos(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*sin(q6)) + (((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*(-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100) + (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)) - ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(39*dq1*sin(q1)*sin(q2)*cos(q4)/100 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)))) - (dq1*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*(-39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 + 39*sin(q1)*sin(q2)*cos(q4)/100 + 2*sin(q1)*sin(q2)/5) + ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)) + dq2*(-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*cos(q1) - ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1) + (((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q1) + (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q1))) + dq3*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*(-(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q2) - (39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2)) + ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q2) + (39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1)) + (((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*sin(q2) - (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2)*cos(q1))) + dq4*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*((39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*sin(q3) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)) + ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*(-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*sin(q3) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)) + (-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3)) + (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2)))*(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))) + dq5*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*(-(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4)) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)) + ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4)) - ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)) + (-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4)) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100))*(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))))*(-dq1*(-sin(q2)*sin(q4)*cos(q3) - cos(q2)*cos(q4))*sin(q5) + dq2*(-(-(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + sin(q2)*cos(q1)*cos(q4))*sin(q1)*sin(q5) + (-(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + sin(q1)*sin(q2)*cos(q4))*sin(q5)*cos(q1)) + dq3*((-(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + sin(q2)*cos(q1)*cos(q4))*sin(q2)*sin(q5)*cos(q1) + (-(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + sin(q1)*sin(q2)*cos(q4))*sin(q1)*sin(q2)*sin(q5) - (-sin(q2)*sin(q4)*cos(q3) - cos(q2)*cos(q4))*sin(q5)*cos(q2)) + dq4*(-(-(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + sin(q2)*cos(q1)*cos(q4))*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) - (-(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + sin(q1)*sin(q2)*cos(q4))*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) + (-sin(q2)*sin(q4)*cos(q3) - cos(q2)*cos(q4))*sin(q2)*sin(q3)*sin(q5)) + dq5*((-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1)) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4)) - (-(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + sin(q2)*cos(q1)*cos(q4))*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q5) - (-(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + sin(q1)*sin(q2)*cos(q4))*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q5) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2)) - (-sin(q2)*sin(q4)*cos(q3) - cos(q2)*cos(q4))*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q5)) + dq6*((-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + sin(q2)*cos(q1)*cos(q4))*sin(q5) - (((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + sin(q2)*cos(q1)*cos(q4))*sin(q5) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + sin(q1)*sin(q2)*cos(q4))*sin(q5) - (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + sin(q1)*sin(q2)*cos(q4))*sin(q5) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*(-sin(q2)*sin(q4)*cos(q3) - cos(q2)*cos(q4))*sin(q5) - ((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5))*(-sin(q2)*sin(q4)*cos(q3) - cos(q2)*cos(q4))*sin(q5))) + (dq1*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*(-39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 + 39*sin(q1)*sin(q2)*cos(q4)/100 + 2*sin(q1)*sin(q2)/5) + ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)) + dq2*(-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*cos(q1) - ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1) + (((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q1) + (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q1))) + dq3*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*(-(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q2) - (39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2)) + ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q2) + (39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1)) + (((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*sin(q2) - (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2)*cos(q1))) + dq4*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*((39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*sin(q3) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)) + ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*(-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*sin(q3) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)) + (-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3)) + (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2)))*(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))) + dq5*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*(-(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4)) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)) + ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4)) - ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)) + (-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4)) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100))*(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))))*(-dq2*(-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q3)*cos(q2) - dq3*(-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q2)*cos(q3) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3)) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1)) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) - dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) - (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*sin(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*cos(q5)) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) - dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q5) - (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*sin(q5)) - (-dq2*sin(q3)*cos(q2)*cos(q5) - dq3*sin(q2)*cos(q3)*cos(q5) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) + dq5*sin(q2)*sin(q3)*sin(q5) - (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*sin(q5))*sin(q2)*sin(q3)) - (dq1*((-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 + 39*sin(q1)*sin(q2)*cos(q4)/100 + 2*sin(q1)*sin(q2)/5) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)) + dq2*(-(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*cos(q1) - (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q1) + (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q1))) + dq3*((-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q2) - (39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2)) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q2) + (39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1)) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*sin(q2) - (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2)*cos(q1))) + dq4*((-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3)) + (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2)))*(-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5)) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*((39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*sin(q3) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*sin(q3) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100))) + dq5*((-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4)) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100))*(-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5)) + ((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4)) - ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100))*(-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5)) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4)) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100))))*(-dq1*((-sin(q2)*sin(q4)*cos(q3) - cos(q2)*cos(q4))*cos(q5)*cos(q6) + (sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q6)) - dq2*(((-(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + sin(q2)*cos(q1)*cos(q4))*cos(q5)*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q6))*sin(q1) - ((-(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + sin(q1)*sin(q2)*cos(q4))*cos(q5)*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q6))*cos(q1)) - dq3*(-((-(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + sin(q2)*cos(q1)*cos(q4))*cos(q5)*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q6))*sin(q2)*cos(q1) - ((-(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + sin(q1)*sin(q2)*cos(q4))*cos(q5)*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q6))*sin(q1)*sin(q2) + ((-sin(q2)*sin(q4)*cos(q3) - cos(q2)*cos(q4))*cos(q5)*cos(q6) + (sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q6))*cos(q2)) - dq4*((-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*((-(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + sin(q2)*cos(q1)*cos(q4))*cos(q5)*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q6)) + ((-(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + sin(q1)*sin(q2)*cos(q4))*cos(q5)*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q6))*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3)) - ((-sin(q2)*sin(q4)*cos(q3) - cos(q2)*cos(q4))*cos(q5)*cos(q6) + (sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q6))*sin(q2)*sin(q3)) - dq5*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1)) + ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4)) + (((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2)) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*((-(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + sin(q2)*cos(q1)*cos(q4))*cos(q5)*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q6)) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*((-(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + sin(q1)*sin(q2)*cos(q4))*cos(q5)*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q6)) + ((-sin(q2)*sin(q4)*cos(q3) - cos(q2)*cos(q4))*cos(q5)*cos(q6) + (sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q6))*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))) - dq6*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*(-(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + sin(q2)*cos(q1)*cos(q4))*sin(q5) + ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*(-(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + sin(q1)*sin(q2)*cos(q4))*sin(q5) + (((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*((-(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + sin(q2)*cos(q1)*cos(q4))*cos(q5)*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q6)) + (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*((-(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + sin(q1)*sin(q2)*cos(q4))*cos(q5)*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q6)) + (((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*(-sin(q2)*sin(q4)*cos(q3) - cos(q2)*cos(q4))*sin(q5) + ((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5))*((-sin(q2)*sin(q4)*cos(q3) - cos(q2)*cos(q4))*cos(q5)*cos(q6) + (sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q6)))) + (dq1*((-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 + 39*sin(q1)*sin(q2)*cos(q4)/100 + 2*sin(q1)*sin(q2)/5) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)) + dq2*(-(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*cos(q1) - (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q1) + (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q1))) + dq3*((-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q2) - (39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2)) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q2) + (39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1)) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*sin(q2) - (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2)*cos(q1))) + dq4*((-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3)) + (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2)))*(-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5)) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*((39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*sin(q3) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*sin(q3) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100))) + dq5*((-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4)) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100))*(-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5)) + ((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4)) - ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100))*(-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5)) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4)) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100))))*(dq2*(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q3)*cos(q2) + dq3*(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q2)*cos(q3) - ((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*(dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3)) - ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*(-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1)) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*cos(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*sin(q6)) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*cos(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*sin(q6)) + (-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*sin(q6) + (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*cos(q6))*sin(q2)*sin(q3)) - (dq1*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*(-39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 - 39*sin(q1)*sin(q2)*sin(q4)/100) + ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*sin(q2)*sin(q4)*cos(q1)/100) + ((-(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + sin(q2)*cos(q1)*cos(q4))*cos(q5)*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q6))*(-39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 + 39*sin(q1)*sin(q2)*cos(q4)/100 + 2*sin(q1)*sin(q2)/5) + ((-(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + sin(q1)*sin(q2)*cos(q4))*cos(q5)*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q6))*(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)) + dq2*(-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*(39*sin(q2)*cos(q3)*cos(q4)/100 - 39*sin(q4)*cos(q2)/100)*cos(q1) - ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*(39*sin(q2)*cos(q3)*cos(q4)/100 - 39*sin(q4)*cos(q2)/100)*sin(q1) + ((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*sin(q2)*sin(q4)*cos(q1)/100)*cos(q1) + (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*sin(q1)*sin(q2)*sin(q4)/100)*sin(q1))*(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)) + ((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q1) + (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q1))*((-sin(q2)*sin(q4)*cos(q3) - cos(q2)*cos(q4))*cos(q5)*cos(q6) + (sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q6)) - ((-(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + sin(q2)*cos(q1)*cos(q4))*cos(q5)*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q6))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*cos(q1) - ((-(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + sin(q1)*sin(q2)*cos(q4))*cos(q5)*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q6))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)) + dq3*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*(-(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*sin(q1)*sin(q2)*sin(q4)/100)*cos(q2) - (39*sin(q2)*cos(q3)*cos(q4)/100 - 39*sin(q4)*cos(q2)/100)*sin(q1)*sin(q2)) + ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*sin(q2)*sin(q4)*cos(q1)/100)*cos(q2) + (39*sin(q2)*cos(q3)*cos(q4)/100 - 39*sin(q4)*cos(q2)/100)*sin(q2)*cos(q1)) + (((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*sin(q2)*sin(q4)*cos(q1)/100)*sin(q1)*sin(q2) - (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*sin(q1)*sin(q2)*sin(q4)/100)*sin(q2)*cos(q1)) + ((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q2) + (39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1))*((-(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + sin(q1)*sin(q2)*cos(q4))*cos(q5)*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q6)) + (-(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q2) - (39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2))*((-(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + sin(q2)*cos(q1)*cos(q4))*cos(q5)*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q6)) + ((-sin(q2)*sin(q4)*cos(q3) - cos(q2)*cos(q4))*cos(q5)*cos(q6) + (sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q6))*((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*sin(q2) - (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2)*cos(q1))) + dq4*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*((39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*sin(q1)*sin(q2)*sin(q4)/100)*sin(q2)*sin(q3) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(39*sin(q2)*cos(q3)*cos(q4)/100 - 39*sin(q4)*cos(q2)/100)) + ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*(-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*sin(q2)*sin(q4)*cos(q1)/100)*sin(q2)*sin(q3) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(39*sin(q2)*cos(q3)*cos(q4)/100 - 39*sin(q4)*cos(q2)/100)) + (-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3)) + (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2)))*((-sin(q2)*sin(q4)*cos(q3) - cos(q2)*cos(q4))*cos(q5)*cos(q6) + (sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q6)) + (-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*sin(q2)*sin(q4)*cos(q1)/100)*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3)) + (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*sin(q1)*sin(q2)*sin(q4)/100)*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2)))*(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)) + ((-(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + sin(q2)*cos(q1)*cos(q4))*cos(q5)*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q6))*((39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*sin(q3) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)) + (-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*sin(q3) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100))*((-(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + sin(q1)*sin(q2)*cos(q4))*cos(q5)*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q6))) + dq5*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*(-(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2)) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(39*sin(q2)*cos(q3)*cos(q4)/100 - 39*sin(q4)*cos(q2)/100) - (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*sin(q1)*sin(q2)*sin(q4)/100)*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4)) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)) + ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2)) - ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(39*sin(q2)*cos(q3)*cos(q4)/100 - 39*sin(q4)*cos(q2)/100) + (39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*sin(q2)*sin(q4)*cos(q1)/100)*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4)) - ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)) + (-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4)) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100))*((-sin(q2)*sin(q4)*cos(q3) - cos(q2)*cos(q4))*cos(q5)*cos(q6) + (sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q6)) + ((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4)) - ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100))*((-(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + sin(q1)*sin(q2)*cos(q4))*cos(q5)*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q6)) + (-(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4)) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100))*((-(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + sin(q2)*cos(q1)*cos(q4))*cos(q5)*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q6)) + (((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*(-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4)) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*sin(q1)*sin(q2)*sin(q4)/100) - (39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*sin(q2)*sin(q4)*cos(q1)/100)*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4)) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100))))*(dq1*(-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5)) + dq2*((-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q1) - (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q1)) + dq3*(-(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q2)*cos(q1) - (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q1)*sin(q2) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q2)) + dq4*((-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2)) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3)) - (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q2)*sin(q3)) + dq5*((-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4)) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4)) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))) + dq6*((-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5)) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5)) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5)))) - (dq1*((-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 - 39*sin(q1)*sin(q2)*sin(q4)/100) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*sin(q2)*sin(q4)*cos(q1)/100) - (-(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + sin(q2)*cos(q1)*cos(q4))*(-39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 + 39*sin(q1)*sin(q2)*cos(q4)/100 + 2*sin(q1)*sin(q2)/5)*sin(q5) - (-(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + sin(q1)*sin(q2)*cos(q4))*(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q5)) + dq2*(((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*sin(q2)*sin(q4)*cos(q1)/100)*cos(q1) + (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*sin(q1)*sin(q2)*sin(q4)/100)*sin(q1))*(-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5)) - (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(39*sin(q2)*cos(q3)*cos(q4)/100 - 39*sin(q4)*cos(q2)/100)*cos(q1) - (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(39*sin(q2)*cos(q3)*cos(q4)/100 - 39*sin(q4)*cos(q2)/100)*sin(q1) + (-(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + sin(q2)*cos(q1)*cos(q4))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q5)*cos(q1) + (-(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + sin(q1)*sin(q2)*cos(q4))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q5) - ((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q1) + (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q1))*(-sin(q2)*sin(q4)*cos(q3) - cos(q2)*cos(q4))*sin(q5)) + dq3*(((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*sin(q2)*sin(q4)*cos(q1)/100)*cos(q2) + (39*sin(q2)*cos(q3)*cos(q4)/100 - 39*sin(q4)*cos(q2)/100)*sin(q2)*cos(q1))*(-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5)) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*sin(q1)*sin(q2)*sin(q4)/100)*cos(q2) - (39*sin(q2)*cos(q3)*cos(q4)/100 - 39*sin(q4)*cos(q2)/100)*sin(q1)*sin(q2)) - (-(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + sin(q2)*cos(q1)*cos(q4))*(-(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q2) - (39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2))*sin(q5) - (-(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + sin(q1)*sin(q2)*cos(q4))*((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q2) + (39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1))*sin(q5) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*sin(q2)*sin(q4)*cos(q1)/100)*sin(q1)*sin(q2) - (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*sin(q1)*sin(q2)*sin(q4)/100)*sin(q2)*cos(q1)) - ((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*sin(q2) - (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2)*cos(q1))*(-sin(q2)*sin(q4)*cos(q3) - cos(q2)*cos(q4))*sin(q5)) + dq4*(-(-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3)) + (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2)))*(-sin(q2)*sin(q4)*cos(q3) - cos(q2)*cos(q4))*sin(q5) + (-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*sin(q2)*sin(q4)*cos(q1)/100)*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3)) + (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*sin(q1)*sin(q2)*sin(q4)/100)*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2)))*(-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5)) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*((39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*sin(q1)*sin(q2)*sin(q4)/100)*sin(q2)*sin(q3) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(39*sin(q2)*cos(q3)*cos(q4)/100 - 39*sin(q4)*cos(q2)/100)) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*sin(q2)*sin(q4)*cos(q1)/100)*sin(q2)*sin(q3) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(39*sin(q2)*cos(q3)*cos(q4)/100 - 39*sin(q4)*cos(q2)/100)) - (-(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + sin(q2)*cos(q1)*cos(q4))*((39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*sin(q3) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100))*sin(q5) - (-(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + sin(q1)*sin(q2)*cos(q4))*(-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*sin(q3) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100))*sin(q5)) + dq5*(-(-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4)) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100))*(-sin(q2)*sin(q4)*cos(q3) - cos(q2)*cos(q4))*sin(q5) - ((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4)) - ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100))*(-(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + sin(q1)*sin(q2)*cos(q4))*sin(q5) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2)) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(39*sin(q2)*cos(q3)*cos(q4)/100 - 39*sin(q4)*cos(q2)/100) - (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*sin(q1)*sin(q2)*sin(q4)/100)*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4)) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)) - (-(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4)) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100))*(-(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + sin(q2)*cos(q1)*cos(q4))*sin(q5) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*((39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2)) - ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(39*sin(q2)*cos(q3)*cos(q4)/100 - 39*sin(q4)*cos(q2)/100) + (39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*sin(q2)*sin(q4)*cos(q1)/100)*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4)) - ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*(-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4)) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*sin(q1)*sin(q2)*sin(q4)/100) - (39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*sin(q2)*sin(q4)*cos(q1)/100)*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4)) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100))))*(-dq1*(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)) - dq2*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q1) - ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q1)) - dq3*(-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q2)*cos(q1) - ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q1)*sin(q2) + (((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q2)) - dq4*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2)) + ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3)) - (((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q2)*sin(q3)) - dq5*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4)) + ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4)) + (((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))) - dq6*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5)) + ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5)) + (((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5)))) + (-dq1*(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)) - dq2*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q1) - ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q1)) - dq3*(-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q2)*cos(q1) - ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q1)*sin(q2) + (((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q2)) - dq4*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2)) + ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3)) - (((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q2)*sin(q3)) - dq5*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4)) + ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4)) + (((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))) - dq6*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5)) + ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5)) + (((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5))))*((-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3)) + (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2)))*(-dq2*sin(q3)*cos(q2)*cos(q5) - dq3*sin(q2)*cos(q3)*cos(q5) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) + dq5*sin(q2)*sin(q3)*sin(q5) - (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*sin(q5)) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(dq2*(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q3)*cos(q2) + dq3*(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*cos(q3) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*dq2*sin(q2)*cos(q4)/100 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100) + (39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)*(-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1)) + (-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100)*sin(q2)*sin(q3)) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-dq2*(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q3)*cos(q2) - dq3*(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*cos(q3) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*dq2*sin(q2)*cos(q4)/100 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100) - (39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)*(dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3)) - (39*dq1*sin(q1)*sin(q2)*cos(q4)/100 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)*sin(q2)*sin(q3)) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*(-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1)) + (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3)) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(39*dq1*sin(q1)*sin(q2)*cos(q4)/100 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)) + (-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*sin(q3) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100))*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) - dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q5) - (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*sin(q5)) + ((39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*sin(q3) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100))*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) - dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) - (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*sin(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*cos(q5))) + (dq1*(-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5)) + dq2*((-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q1) - (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q1)) + dq3*(-(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q2)*cos(q1) - (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q1)*sin(q2) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q2)) + dq4*((-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2)) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3)) - (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q2)*sin(q3)) + dq5*((-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4)) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4)) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))) + dq6*((-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5)) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5)) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5))))*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*(dq2*(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q3)*cos(q2) + dq3*(39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*cos(q3) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*dq2*sin(q2)*cos(q4)/100 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100) + (39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)*(-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1)) + (-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100)*sin(q2)*sin(q3)) + ((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*(-dq2*(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q3)*cos(q2) - dq3*(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*cos(q3) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*dq2*sin(q2)*cos(q4)/100 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100) - (39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)*(dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3)) - (39*dq1*sin(q1)*sin(q2)*cos(q4)/100 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)*sin(q2)*sin(q3)) + (-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3)) + (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2)))*(-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*sin(q6) + (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*cos(q6)) + (((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*(-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1)) + (39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3)) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(39*dq1*sin(q1)*sin(q2)*cos(q4)/100 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)) + (-(39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*sin(q3) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100))*(-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*cos(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*sin(q6)) + ((39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*sin(q3) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100))*(-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*cos(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*sin(q6)))')



######## very large size expression
verylargeExpr = S('(-981*(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7)/100 + 981*(-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7)/100)*((-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*(-39*((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*sin(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*cos(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)/100) + (-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7))*(-39*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*sin(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*cos(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)/100) + (-(((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*cos(q6) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*sin(q6))*sin(q7) + ((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*cos(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5)*cos(q4))*cos(q7))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5) + (-(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7))*(-39*(-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*sin(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)*cos(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)/100) + (-(((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*cos(q6) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*sin(q6))*sin(q7) + (-(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5)*cos(q4) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*cos(q5))*cos(q7))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5) + (-((-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*cos(q6) - sin(q2)*sin(q3)*sin(q4)*sin(q6))*sin(q7) + (sin(q2)*sin(q3)*sin(q5)*cos(q4) - sin(q2)*cos(q3)*cos(q5))*cos(q7))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5 + 31/100)) + (981*(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7)/100 + 981*(-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7)/100)*((((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*(-39*((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*sin(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*cos(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)/100) + (((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7))*(-39*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*sin(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*cos(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)/100) + ((((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*cos(q6) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*sin(q6))*cos(q7) + ((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*cos(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5)*cos(q4))*sin(q7))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5) + ((((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7))*(-39*(-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*sin(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)*cos(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)/100) + ((((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*cos(q6) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*sin(q6))*cos(q7) + (-(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5)*cos(q4) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*cos(q5))*sin(q7))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5) + (((-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*cos(q6) - sin(q2)*sin(q3)*sin(q4)*sin(q6))*cos(q7) + (sin(q2)*sin(q3)*sin(q5)*cos(q4) - sin(q2)*cos(q3)*cos(q5))*sin(q7))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5 + 31/100)) + (-981*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/100 + 981*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/100)*((-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*sin(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*cos(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)/100) + (-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-39*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*sin(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*cos(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)/100) + (-((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*sin(q6) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*cos(q6))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5) + (-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6))*(-39*(-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*sin(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)*cos(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)/100) + (-((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*sin(q6) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*cos(q6))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5) + (-(-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*sin(q6) - sin(q2)*sin(q3)*sin(q4)*cos(q6))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5 + 31/100)) + (-981*((-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*cos(q6) - sin(q2)*sin(q3)*sin(q4)*sin(q6))*sin(q7)/100 + 981*(sin(q2)*sin(q3)*sin(q5)*cos(q4) - sin(q2)*cos(q3)*cos(q5))*cos(q7)/100)*((-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5) + (-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5) + (-(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5 + 31/100)) + (981*((-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*cos(q6) - sin(q2)*sin(q3)*sin(q4)*sin(q6))*cos(q7)/100 + 981*(sin(q2)*sin(q3)*sin(q5)*cos(q4) - sin(q2)*cos(q3)*cos(q5))*sin(q7)/100)*((((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5) + (((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5) + ((((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5 + 31/100)) + (-981*(-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*sin(q6)/100 - 981*sin(q2)*sin(q3)*sin(q4)*cos(q6)/100)*((-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5) + (-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5) + (-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5 + 31/100)) + (2*(-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*(-(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q2) - (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2)) + 2*(-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q2) + (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1)) + 2*(-(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*sin(q2) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2)*cos(q1)))*(ddq1*((-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*(39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 - 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 - 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 + 39*sin(q1)*sin(q2)*cos(q4)/100 + 2*sin(q1)*sin(q2)/5) + (-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)) + ddq2*(-(-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*cos(q1) - (-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1) + (-(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q1) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q1))) + ddq3*((-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*(-(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q2) - (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2)) + (-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q2) + (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1)) + (-(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*sin(q2) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2)*cos(q1))) + ddq4*((-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*sin(q3)) + (-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7))*(-(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*sin(q3)) + (-(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7))*((-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100))) + ddq5*((-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) - (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)) + (-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7))*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)) + (-(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7))*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100) - ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100))) + ddq6*((-(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5)) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5)))*(-(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7)) + ((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5)) - (((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500))*(-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7)) + (-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*(-(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5)) + (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500))) + ddq7*(((-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)))*(-(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7)) + (-(-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500) + (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)))*(-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7)) + (-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*((-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)))) + dq1*((-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*(39*dq1*sin(q2)*cos(q1)*cos(q4)/100 + 2*dq1*sin(q2)*cos(q1)/5 + 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 + 2*dq2*sin(q1)*cos(q2)/5 - 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 - 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 + 39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 + 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 + 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 - 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100 - 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500) + (-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7))*(39*dq1*sin(q1)*sin(q2)*cos(q4)/100 + 2*dq1*sin(q1)*sin(q2)/5 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 - 2*dq2*cos(q1)*cos(q2)/5 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 - 39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100) + (-dq7*((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) - dq7*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) - dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) - (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*sin(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*cos(q5))*cos(q7) - (-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*cos(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*sin(q6))*sin(q7))*(39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 - 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 - 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 + 39*sin(q1)*sin(q2)*cos(q4)/100 + 2*sin(q1)*sin(q2)/5) + (-dq7*((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) - dq7*(-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) - dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q5) - (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*sin(q5))*cos(q7) - (-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*cos(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*sin(q6))*sin(q7))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)) + dq2*(dq1*(-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1) - dq1*(-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*cos(q1) - (-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*(-39*dq2*sin(q2)*cos(q4)/100 - 2*dq2*sin(q2)/5 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100 - 39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500)*cos(q1) - (-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7))*(-39*dq2*sin(q2)*cos(q4)/100 - 2*dq2*sin(q2)/5 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100 - 39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500)*sin(q1) + (-(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7))*(-dq1*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1) + dq1*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q1) + (39*dq1*sin(q1)*sin(q2)*cos(q4)/100 + 2*dq1*sin(q1)*sin(q2)/5 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 - 2*dq2*cos(q1)*cos(q2)/5 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 - 39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)*cos(q1) + (-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 2*dq1*sin(q2)*cos(q1)/5 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 - 2*dq2*sin(q1)*cos(q2)/5 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 - 39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500)*sin(q1)) + ((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q1) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q1))*(-dq7*(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) - dq7*(-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7) - (-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*sin(q6) + (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*cos(q6))*sin(q7) + (-dq2*sin(q3)*cos(q2)*cos(q5) - dq3*sin(q2)*cos(q3)*cos(q5) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) + dq5*sin(q2)*sin(q3)*sin(q5) - (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*sin(q5))*cos(q7)) - (-dq7*((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) - dq7*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) - dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) - (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*sin(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*cos(q5))*cos(q7) - (-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*cos(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*sin(q6))*sin(q7))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*cos(q1) - (-dq7*((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) - dq7*(-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) - dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q5) - (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*sin(q5))*cos(q7) - (-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*cos(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*sin(q6))*sin(q7))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)) + dq3*((-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*(-dq1*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1) + dq2*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2) - dq2*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*cos(q2) - (-39*dq2*sin(q2)*cos(q4)/100 - 2*dq2*sin(q2)/5 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100 - 39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500)*sin(q1)*sin(q2) - (-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 2*dq1*sin(q2)*cos(q1)/5 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 - 2*dq2*sin(q1)*cos(q2)/5 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 - 39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500)*cos(q2)) + (-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7))*(-dq1*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2) - dq2*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q2) + dq2*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*cos(q1)*cos(q2) + (-39*dq2*sin(q2)*cos(q4)/100 - 2*dq2*sin(q2)/5 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100 - 39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500)*sin(q2)*cos(q1) + (39*dq1*sin(q1)*sin(q2)*cos(q4)/100 + 2*dq1*sin(q1)*sin(q2)/5 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 - 2*dq2*cos(q1)*cos(q2)/5 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 - 39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)*cos(q2)) + (-(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7))*(dq1*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q2)*cos(q1) + dq1*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q1)*sin(q2) + dq2*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*cos(q2) - dq2*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q1)*cos(q2) + (39*dq1*sin(q1)*sin(q2)*cos(q4)/100 + 2*dq1*sin(q1)*sin(q2)/5 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 - 2*dq2*cos(q1)*cos(q2)/5 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 - 39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)*sin(q1)*sin(q2) - (-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 2*dq1*sin(q2)*cos(q1)/5 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 - 2*dq2*sin(q1)*cos(q2)/5 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 - 39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500)*sin(q2)*cos(q1)) + ((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q2) + (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1))*(-dq7*((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) - dq7*(-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) - dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q5) - (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*sin(q5))*cos(q7) - (-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*cos(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*sin(q6))*sin(q7)) + (-(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q2) - (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2))*(-dq7*((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) - dq7*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) - dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) - (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*sin(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*cos(q5))*cos(q7) - (-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*cos(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*sin(q6))*sin(q7)) + ((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*sin(q2) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2)*cos(q1))*(-dq7*(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) - dq7*(-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7) - (-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*sin(q6) + (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*cos(q6))*sin(q7) + (-dq2*sin(q3)*cos(q2)*cos(q5) - dq3*sin(q2)*cos(q3)*cos(q5) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) + dq5*sin(q2)*sin(q3)*sin(q5) - (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*sin(q5))*cos(q7))) + dq4*((-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*(dq2*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q3)*cos(q2) + dq3*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*cos(q3) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*dq2*sin(q2)*cos(q4)/100 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100 - 39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500) + (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)*(-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1)) + (-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 - 39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500)*sin(q2)*sin(q3)) + (-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7))*(-dq2*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q3)*cos(q2) - dq3*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*cos(q3) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*dq2*sin(q2)*cos(q4)/100 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100 - 39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500) - (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)*(dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3)) - (39*dq1*sin(q1)*sin(q2)*cos(q4)/100 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 - 39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)*sin(q2)*sin(q3)) + (-(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7))*((-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 - 39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(39*dq1*sin(q1)*sin(q2)*cos(q4)/100 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 - 39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1)) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))) + ((-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100))*(-dq7*(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) - dq7*(-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7) - (-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*sin(q6) + (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*cos(q6))*sin(q7) + (-dq2*sin(q3)*cos(q2)*cos(q5) - dq3*sin(q2)*cos(q3)*cos(q5) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) + dq5*sin(q2)*sin(q3)*sin(q5) - (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*sin(q5))*cos(q7)) + (-(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*sin(q3))*(-dq7*((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) - dq7*(-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) - dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q5) - (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*sin(q5))*cos(q7) - (-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*cos(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*sin(q6))*sin(q7)) + ((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*sin(q3))*(-dq7*((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) - dq7*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) - dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) - (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*sin(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*cos(q5))*cos(q7) - (-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*cos(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*sin(q6))*sin(q7))) + dq5*((-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-39*dq2*sin(q2)*cos(q4)/100 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100 - 39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500) - (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 - 39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2)) + (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))) + (-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7))*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*dq2*sin(q2)*cos(q4)/100 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100 - 39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(39*dq1*sin(q1)*sin(q2)*cos(q4)/100 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 - 39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100) + (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2)) - (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))) + (-(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7))*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 - 39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500) - ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(39*dq1*sin(q1)*sin(q2)*cos(q4)/100 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 - 39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))) + (((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100) - ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100))*(-dq7*(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) - dq7*(-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7) - (-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*sin(q6) + (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*cos(q6))*sin(q7) + (-dq2*sin(q3)*cos(q2)*cos(q5) - dq3*sin(q2)*cos(q3)*cos(q5) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) + dq5*sin(q2)*sin(q3)*sin(q5) - (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*sin(q5))*cos(q7)) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100))*(-dq7*((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) - dq7*(-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) - dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q5) - (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*sin(q5))*cos(q7) - (-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*cos(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*sin(q6))*sin(q7)) + (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) - (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100))*(-dq7*((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) - dq7*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) - dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) - (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*sin(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*cos(q5))*cos(q7) - (-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*cos(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*sin(q6))*sin(q7))) + dq6*((-(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5)) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5)))*(-dq7*(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) - dq7*(-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7) - (-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*sin(q6) + (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*cos(q6))*sin(q7) + (-dq2*sin(q3)*cos(q2)*cos(q5) - dq3*sin(q2)*cos(q3)*cos(q5) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) + dq5*sin(q2)*sin(q3)*sin(q5) - (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*sin(q5))*cos(q7)) + ((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5)) - (((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500))*(-dq7*((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) - dq7*(-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) - dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q5) - (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*sin(q5))*cos(q7) - (-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*cos(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*sin(q6))*sin(q7)) + (-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*(-(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(dq2*sin(q3)*cos(q2)*cos(q5) + dq3*sin(q2)*cos(q3)*cos(q5) + dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - dq5*sin(q2)*sin(q3)*sin(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*sin(q5)) + (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500) + (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500)*(dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) - (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*sin(q5)) - ((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5))*(-39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500)) + (-(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5)) + (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500))*(-dq7*((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) - dq7*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) - dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) - (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*sin(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*cos(q5))*cos(q7) - (-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*cos(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*sin(q6))*sin(q7)) + (-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(dq2*sin(q3)*cos(q2)*cos(q5) + dq3*sin(q2)*cos(q3)*cos(q5) + dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - dq5*sin(q2)*sin(q3)*sin(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*sin(q5)) - (((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500) - (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500)*(dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*sin(q5) - (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*cos(q5)) + ((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5))*(-39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500)) + (-(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7))*(-(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) - (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*sin(q5)) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*sin(q5) - (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*cos(q5)) + (((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500) - (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500))) + dq7*(((-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)))*(-dq7*(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) - dq7*(-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7) - (-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*sin(q6) + (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*cos(q6))*sin(q7) + (-dq2*sin(q3)*cos(q2)*cos(q5) - dq3*sin(q2)*cos(q3)*cos(q5) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) + dq5*sin(q2)*sin(q3)*sin(q5) - (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*sin(q5))*cos(q7)) + (-(-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500) + (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)))*(-dq7*((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) - dq7*(-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) - dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q5) - (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*sin(q5))*cos(q7) - (-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*cos(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*sin(q6))*sin(q7)) + (-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*((-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) - dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6) - (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)) - (-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6))*(-39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500) + (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500)*(-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) - dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6) - (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6))) + ((-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)))*(-dq7*((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) - dq7*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) - dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) - (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*sin(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*cos(q5))*cos(q7) - (-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*cos(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*sin(q6))*sin(q7)) + (-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7))*(-(-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500) + (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) - dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6) - (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)) + (-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6))*(-39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500) - (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500)*(-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) - dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6) - (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6))) + (-(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7))*((-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) - dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6) - (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)) - (-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) - dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6) - (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)))))/2 + (2*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*(-(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q2) - (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2)) + 2*(((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q2) + (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1)) + 2*((((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*sin(q2) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2)*cos(q1)))*(ddq1*((((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*(39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 - 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 - 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 + 39*sin(q1)*sin(q2)*cos(q4)/100 + 2*sin(q1)*sin(q2)/5) + (((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)) + ddq2*(-(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*cos(q1) - (((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1) + ((((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q1) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q1))) + ddq3*((((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*(-(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q2) - (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2)) + (((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q2) + (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1)) + ((((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*sin(q2) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2)*cos(q1))) + ddq4*((((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*sin(q3)) + (((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7))*(-(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*sin(q3)) + ((((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7))*((-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100))) + ddq5*((((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) - (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)) + (((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7))*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)) + ((((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7))*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100) - ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100))) + ddq6*((-(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5)) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5)))*((((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7)) + ((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5)) - (((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500))*(((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7)) + (((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*(-(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5)) + (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500))) + ddq7*(((-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)))*((((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7)) + (-(-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500) + (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)))*(((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7)) + (((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*((-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)))) + dq1*((((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*(39*dq1*sin(q2)*cos(q1)*cos(q4)/100 + 2*dq1*sin(q2)*cos(q1)/5 + 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 + 2*dq2*sin(q1)*cos(q2)/5 - 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 - 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 + 39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 + 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 + 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 - 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100 - 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500) + (((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7))*(39*dq1*sin(q1)*sin(q2)*cos(q4)/100 + 2*dq1*sin(q1)*sin(q2)/5 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 - 2*dq2*cos(q1)*cos(q2)/5 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 - 39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100) + (-dq7*((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + dq7*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) - dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) - (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*sin(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*cos(q5))*sin(q7) + (-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*cos(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*sin(q6))*cos(q7))*(39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 - 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 - 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 + 39*sin(q1)*sin(q2)*cos(q4)/100 + 2*sin(q1)*sin(q2)/5) + (-dq7*((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + dq7*(-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) - dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q5) - (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*sin(q5))*sin(q7) + (-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*cos(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*sin(q6))*cos(q7))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)) + dq2*(dq1*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1) - dq1*(((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*cos(q1) - (((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*(-39*dq2*sin(q2)*cos(q4)/100 - 2*dq2*sin(q2)/5 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100 - 39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500)*cos(q1) - (((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7))*(-39*dq2*sin(q2)*cos(q4)/100 - 2*dq2*sin(q2)/5 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100 - 39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500)*sin(q1) + ((((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7))*(-dq1*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1) + dq1*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q1) + (39*dq1*sin(q1)*sin(q2)*cos(q4)/100 + 2*dq1*sin(q1)*sin(q2)/5 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 - 2*dq2*cos(q1)*cos(q2)/5 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 - 39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)*cos(q1) + (-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 2*dq1*sin(q2)*cos(q1)/5 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 - 2*dq2*sin(q1)*cos(q2)/5 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 - 39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500)*sin(q1)) + ((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q1) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q1))*(-dq7*(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + dq7*(-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7) + (-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*sin(q6) + (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*cos(q6))*cos(q7) + (-dq2*sin(q3)*cos(q2)*cos(q5) - dq3*sin(q2)*cos(q3)*cos(q5) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) + dq5*sin(q2)*sin(q3)*sin(q5) - (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*sin(q5))*sin(q7)) - (-dq7*((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + dq7*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) - dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) - (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*sin(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*cos(q5))*sin(q7) + (-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*cos(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*sin(q6))*cos(q7))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*cos(q1) - (-dq7*((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + dq7*(-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) - dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q5) - (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*sin(q5))*sin(q7) + (-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*cos(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*sin(q6))*cos(q7))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)) + dq3*((((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*(-dq1*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1) + dq2*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2) - dq2*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*cos(q2) - (-39*dq2*sin(q2)*cos(q4)/100 - 2*dq2*sin(q2)/5 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100 - 39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500)*sin(q1)*sin(q2) - (-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 2*dq1*sin(q2)*cos(q1)/5 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 - 2*dq2*sin(q1)*cos(q2)/5 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 - 39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500)*cos(q2)) + (((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7))*(-dq1*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2) - dq2*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q2) + dq2*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*cos(q1)*cos(q2) + (-39*dq2*sin(q2)*cos(q4)/100 - 2*dq2*sin(q2)/5 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100 - 39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500)*sin(q2)*cos(q1) + (39*dq1*sin(q1)*sin(q2)*cos(q4)/100 + 2*dq1*sin(q1)*sin(q2)/5 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 - 2*dq2*cos(q1)*cos(q2)/5 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 - 39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)*cos(q2)) + ((((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7))*(dq1*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q2)*cos(q1) + dq1*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q1)*sin(q2) + dq2*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*cos(q2) - dq2*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q1)*cos(q2) + (39*dq1*sin(q1)*sin(q2)*cos(q4)/100 + 2*dq1*sin(q1)*sin(q2)/5 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 - 2*dq2*cos(q1)*cos(q2)/5 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 - 39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)*sin(q1)*sin(q2) - (-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 2*dq1*sin(q2)*cos(q1)/5 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 - 2*dq2*sin(q1)*cos(q2)/5 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 - 39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500)*sin(q2)*cos(q1)) + ((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q2) + (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1))*(-dq7*((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + dq7*(-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) - dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q5) - (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*sin(q5))*sin(q7) + (-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*cos(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*sin(q6))*cos(q7)) + (-(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q2) - (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2))*(-dq7*((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + dq7*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) - dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) - (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*sin(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*cos(q5))*sin(q7) + (-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*cos(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*sin(q6))*cos(q7)) + ((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*sin(q2) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2)*cos(q1))*(-dq7*(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + dq7*(-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7) + (-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*sin(q6) + (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*cos(q6))*cos(q7) + (-dq2*sin(q3)*cos(q2)*cos(q5) - dq3*sin(q2)*cos(q3)*cos(q5) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) + dq5*sin(q2)*sin(q3)*sin(q5) - (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*sin(q5))*sin(q7))) + dq4*((((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*(dq2*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q3)*cos(q2) + dq3*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*cos(q3) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*dq2*sin(q2)*cos(q4)/100 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100 - 39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500) + (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)*(-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1)) + (-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 - 39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500)*sin(q2)*sin(q3)) + (((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7))*(-dq2*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q3)*cos(q2) - dq3*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*cos(q3) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*dq2*sin(q2)*cos(q4)/100 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100 - 39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500) - (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)*(dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3)) - (39*dq1*sin(q1)*sin(q2)*cos(q4)/100 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 - 39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)*sin(q2)*sin(q3)) + ((((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7))*((-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 - 39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(39*dq1*sin(q1)*sin(q2)*cos(q4)/100 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 - 39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1)) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))) + ((-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100))*(-dq7*(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + dq7*(-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7) + (-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*sin(q6) + (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*cos(q6))*cos(q7) + (-dq2*sin(q3)*cos(q2)*cos(q5) - dq3*sin(q2)*cos(q3)*cos(q5) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) + dq5*sin(q2)*sin(q3)*sin(q5) - (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*sin(q5))*sin(q7)) + (-(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*sin(q3))*(-dq7*((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + dq7*(-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) - dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q5) - (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*sin(q5))*sin(q7) + (-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*cos(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*sin(q6))*cos(q7)) + ((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*sin(q3))*(-dq7*((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + dq7*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) - dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) - (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*sin(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*cos(q5))*sin(q7) + (-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*cos(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*sin(q6))*cos(q7))) + dq5*((((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-39*dq2*sin(q2)*cos(q4)/100 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100 - 39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500) - (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 - 39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2)) + (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))) + (((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7))*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*dq2*sin(q2)*cos(q4)/100 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100 - 39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(39*dq1*sin(q1)*sin(q2)*cos(q4)/100 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 - 39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100) + (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2)) - (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))) + ((((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7))*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 - 39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500) - ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(39*dq1*sin(q1)*sin(q2)*cos(q4)/100 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 - 39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))) + (((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100) - ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100))*(-dq7*(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + dq7*(-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7) + (-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*sin(q6) + (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*cos(q6))*cos(q7) + (-dq2*sin(q3)*cos(q2)*cos(q5) - dq3*sin(q2)*cos(q3)*cos(q5) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) + dq5*sin(q2)*sin(q3)*sin(q5) - (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*sin(q5))*sin(q7)) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100))*(-dq7*((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + dq7*(-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) - dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q5) - (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*sin(q5))*sin(q7) + (-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*cos(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*sin(q6))*cos(q7)) + (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) - (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100))*(-dq7*((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + dq7*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) - dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) - (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*sin(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*cos(q5))*sin(q7) + (-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*cos(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*sin(q6))*cos(q7))) + dq6*((-(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5)) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5)))*(-dq7*(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + dq7*(-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7) + (-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*sin(q6) + (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*cos(q6))*cos(q7) + (-dq2*sin(q3)*cos(q2)*cos(q5) - dq3*sin(q2)*cos(q3)*cos(q5) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) + dq5*sin(q2)*sin(q3)*sin(q5) - (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*sin(q5))*sin(q7)) + ((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5)) - (((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500))*(-dq7*((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + dq7*(-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) - dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q5) - (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*sin(q5))*sin(q7) + (-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*cos(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*sin(q6))*cos(q7)) + (((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*(-(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(dq2*sin(q3)*cos(q2)*cos(q5) + dq3*sin(q2)*cos(q3)*cos(q5) + dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - dq5*sin(q2)*sin(q3)*sin(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*sin(q5)) + (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500) + (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500)*(dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) - (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*sin(q5)) - ((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5))*(-39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500)) + (-(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5)) + (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500))*(-dq7*((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + dq7*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) - dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) - (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*sin(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*cos(q5))*sin(q7) + (-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*cos(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*sin(q6))*cos(q7)) + (((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(dq2*sin(q3)*cos(q2)*cos(q5) + dq3*sin(q2)*cos(q3)*cos(q5) + dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - dq5*sin(q2)*sin(q3)*sin(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*sin(q5)) - (((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500) - (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500)*(dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*sin(q5) - (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*cos(q5)) + ((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5))*(-39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500)) + ((((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7))*(-(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) - (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*sin(q5)) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*sin(q5) - (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*cos(q5)) + (((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500) - (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500))) + dq7*(((-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)))*(-dq7*(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + dq7*(-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7) + (-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*sin(q6) + (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*cos(q6))*cos(q7) + (-dq2*sin(q3)*cos(q2)*cos(q5) - dq3*sin(q2)*cos(q3)*cos(q5) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) + dq5*sin(q2)*sin(q3)*sin(q5) - (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*sin(q5))*sin(q7)) + (-(-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500) + (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)))*(-dq7*((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + dq7*(-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) - dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q5) - (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*sin(q5))*sin(q7) + (-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*cos(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*sin(q6))*cos(q7)) + (((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*((-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) - dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6) - (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)) - (-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6))*(-39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500) + (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500)*(-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) - dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6) - (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6))) + ((-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)))*(-dq7*((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + dq7*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) - dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) - (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*sin(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*cos(q5))*sin(q7) + (-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*cos(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*sin(q6))*cos(q7)) + (((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7))*(-(-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500) + (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) - dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6) - (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)) + (-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6))*(-39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500) - (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500)*(-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) - dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6) - (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6))) + ((((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7))*((-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) - dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6) - (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)) - (-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) - dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6) - (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)))))/2 + (2*(-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q2) - (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2)) + 2*(-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q2) + (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1)) + 2*(-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*sin(q2) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2)*cos(q1)))*(ddq1*((-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 - 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 - 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 + 39*sin(q1)*sin(q2)*cos(q4)/100 + 2*sin(q1)*sin(q2)/5) + (-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)) + ddq2*(-(-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*cos(q1) - (-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1) + (-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q1) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q1))) + ddq3*((-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q2) - (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2)) + (-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q2) + (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1)) + (-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*sin(q2) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2)*cos(q1))) + ddq4*((-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*sin(q3)) + (-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*sin(q3)) + (-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6))*((-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100))) + ddq5*((-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) - (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)) + (-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)) + (((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100) - ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100))*(-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6))) + ddq6*((-(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5)) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5)))*(-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)) + ((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5)) - (((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500))*(-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)) + (-(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5)) + (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500))*(-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))) + ddq7*(((-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)))*(-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)) + (-(-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500) + (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)))*(-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)) + ((-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)))*(-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))) + dq1*((-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(39*dq1*sin(q2)*cos(q1)*cos(q4)/100 + 2*dq1*sin(q2)*cos(q1)/5 + 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 + 2*dq2*sin(q1)*cos(q2)/5 - 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 - 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 + 39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 + 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 + 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 - 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100 - 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500) + (-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(39*dq1*sin(q1)*sin(q2)*cos(q4)/100 + 2*dq1*sin(q1)*sin(q2)/5 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 - 2*dq2*cos(q1)*cos(q2)/5 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 - 39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100) + (-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) - dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6) - (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6))*(39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 - 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 - 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 + 39*sin(q1)*sin(q2)*cos(q4)/100 + 2*sin(q1)*sin(q2)/5) + (-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) - dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6) - (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)) + dq2*(dq1*(-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1) - dq1*(-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*cos(q1) - (-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*dq2*sin(q2)*cos(q4)/100 - 2*dq2*sin(q2)/5 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100 - 39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500)*cos(q1) - (-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-39*dq2*sin(q2)*cos(q4)/100 - 2*dq2*sin(q2)/5 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100 - 39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500)*sin(q1) + (-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6))*(-dq1*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1) + dq1*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q1) + (39*dq1*sin(q1)*sin(q2)*cos(q4)/100 + 2*dq1*sin(q1)*sin(q2)/5 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 - 2*dq2*cos(q1)*cos(q2)/5 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 - 39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)*cos(q1) + (-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 2*dq1*sin(q2)*cos(q1)/5 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 - 2*dq2*sin(q1)*cos(q2)/5 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 - 39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500)*sin(q1)) + ((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q1) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q1))*(-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) - dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6) - (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)) - (-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) - dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6) - (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*cos(q1) - (-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) - dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6) - (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)) + dq3*((-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-dq1*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1) + dq2*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2) - dq2*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*cos(q2) - (-39*dq2*sin(q2)*cos(q4)/100 - 2*dq2*sin(q2)/5 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100 - 39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500)*sin(q1)*sin(q2) - (-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 2*dq1*sin(q2)*cos(q1)/5 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 - 2*dq2*sin(q1)*cos(q2)/5 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 - 39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500)*cos(q2)) + (-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-dq1*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2) - dq2*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q2) + dq2*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*cos(q1)*cos(q2) + (-39*dq2*sin(q2)*cos(q4)/100 - 2*dq2*sin(q2)/5 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100 - 39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500)*sin(q2)*cos(q1) + (39*dq1*sin(q1)*sin(q2)*cos(q4)/100 + 2*dq1*sin(q1)*sin(q2)/5 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 - 2*dq2*cos(q1)*cos(q2)/5 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 - 39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)*cos(q2)) + (-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6))*(dq1*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q2)*cos(q1) + dq1*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q1)*sin(q2) + dq2*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*cos(q2) - dq2*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q1)*cos(q2) + (39*dq1*sin(q1)*sin(q2)*cos(q4)/100 + 2*dq1*sin(q1)*sin(q2)/5 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 - 2*dq2*cos(q1)*cos(q2)/5 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 - 39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)*sin(q1)*sin(q2) - (-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 2*dq1*sin(q2)*cos(q1)/5 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 - 2*dq2*sin(q1)*cos(q2)/5 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 - 39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500)*sin(q2)*cos(q1)) + ((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q2) + (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1))*(-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) - dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6) - (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)) + (-(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q2) - (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2))*(-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) - dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6) - (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)) + ((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*sin(q2) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2)*cos(q1))*(-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) - dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6) - (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6))) + dq4*((-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(dq2*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q3)*cos(q2) + dq3*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*cos(q3) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*dq2*sin(q2)*cos(q4)/100 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100 - 39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500) + (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)*(-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1)) + (-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 - 39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500)*sin(q2)*sin(q3)) + (-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-dq2*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q3)*cos(q2) - dq3*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*cos(q3) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*dq2*sin(q2)*cos(q4)/100 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100 - 39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500) - (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)*(dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3)) - (39*dq1*sin(q1)*sin(q2)*cos(q4)/100 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 - 39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)*sin(q2)*sin(q3)) + (-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6))*((-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 - 39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(39*dq1*sin(q1)*sin(q2)*cos(q4)/100 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 - 39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1)) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))) + ((-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100))*(-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) - dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6) - (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)) + (-(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*sin(q3))*(-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) - dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6) - (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)) + ((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*sin(q3))*(-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) - dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6) - (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6))) + dq5*((-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-39*dq2*sin(q2)*cos(q4)/100 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100 - 39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500) - (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 - 39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2)) + (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))) + (-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*dq2*sin(q2)*cos(q4)/100 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100 - 39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(39*dq1*sin(q1)*sin(q2)*cos(q4)/100 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 - 39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100) + (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2)) - (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))) + (((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100) - ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100))*(-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) - dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6) - (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100))*(-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) - dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6) - (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)) + (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) - (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100))*(-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) - dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6) - (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)) + (-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6))*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 - 39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500) - ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(39*dq1*sin(q1)*sin(q2)*cos(q4)/100 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 - 39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)))) + dq6*((-(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5)) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5)))*(-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) - dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6) - (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)) + ((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5)) - (((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500))*(-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) - dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6) - (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)) + (-(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5)) + (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500))*(-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) - dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6) - (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)) + (-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(dq2*sin(q3)*cos(q2)*cos(q5) + dq3*sin(q2)*cos(q3)*cos(q5) + dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - dq5*sin(q2)*sin(q3)*sin(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*sin(q5)) + (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500) + (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500)*(dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) - (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*sin(q5)) - ((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5))*(-39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500)) + (-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(dq2*sin(q3)*cos(q2)*cos(q5) + dq3*sin(q2)*cos(q3)*cos(q5) + dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - dq5*sin(q2)*sin(q3)*sin(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*sin(q5)) - (((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500) - (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500)*(dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*sin(q5) - (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*cos(q5)) + ((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5))*(-39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500)) + (-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6))*(-(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) - (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*sin(q5)) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*sin(q5) - (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*cos(q5)) + (((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500) - (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500))) + dq7*(((-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)))*(-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) - dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6) - (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)) + (-(-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500) + (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)))*(-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) - dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6) - (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)) + ((-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)))*(-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) - dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6) - (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)) + (-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*((-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) - dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6) - (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)) - (-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6))*(-39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500) + (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500)*(-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) - dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6) - (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6))) + (-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-(-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500) + (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) - dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6) - (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)) + (-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6))*(-39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500) - (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500)*(-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) - dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6) - (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6))) + (-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6))*((-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) - dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6) - (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)) - (-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) - dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6) - (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)))))/2 + (2*(-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*(-dq1*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1) + dq2*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2) - dq2*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*cos(q2) - (-39*dq2*sin(q2)*cos(q4)/100 - 2*dq2*sin(q2)/5 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100 - 39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500)*sin(q1)*sin(q2) - (-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 2*dq1*sin(q2)*cos(q1)/5 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 - 2*dq2*sin(q1)*cos(q2)/5 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 - 39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500)*cos(q2)) + 2*(-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7))*(-dq1*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2) - dq2*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q2) + dq2*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*cos(q1)*cos(q2) + (-39*dq2*sin(q2)*cos(q4)/100 - 2*dq2*sin(q2)/5 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100 - 39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500)*sin(q2)*cos(q1) + (39*dq1*sin(q1)*sin(q2)*cos(q4)/100 + 2*dq1*sin(q1)*sin(q2)/5 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 - 2*dq2*cos(q1)*cos(q2)/5 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 - 39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)*cos(q2)) + 2*(-(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7))*(dq1*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q2)*cos(q1) + dq1*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q1)*sin(q2) + dq2*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*cos(q2) - dq2*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q1)*cos(q2) + (39*dq1*sin(q1)*sin(q2)*cos(q4)/100 + 2*dq1*sin(q1)*sin(q2)/5 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 - 2*dq2*cos(q1)*cos(q2)/5 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 - 39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)*sin(q1)*sin(q2) - (-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 2*dq1*sin(q2)*cos(q1)/5 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 - 2*dq2*sin(q1)*cos(q2)/5 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 - 39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500)*sin(q2)*cos(q1)) + 2*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q2) + (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1))*(-dq7*((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) - dq7*(-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) - dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q5) - (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*sin(q5))*cos(q7) - (-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*cos(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*sin(q6))*sin(q7)) + 2*(-(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q2) - (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2))*(-dq7*((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) - dq7*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) - dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) - (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*sin(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*cos(q5))*cos(q7) - (-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*cos(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*sin(q6))*sin(q7)) + 2*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*sin(q2) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2)*cos(q1))*(-dq7*(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) - dq7*(-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7) - (-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*sin(q6) + (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*cos(q6))*sin(q7) + (-dq2*sin(q3)*cos(q2)*cos(q5) - dq3*sin(q2)*cos(q3)*cos(q5) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) + dq5*sin(q2)*sin(q3)*sin(q5) - (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*sin(q5))*cos(q7)))*(dq1*((-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*(39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 - 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 - 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 + 39*sin(q1)*sin(q2)*cos(q4)/100 + 2*sin(q1)*sin(q2)/5) + (-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)) + dq2*(-(-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*cos(q1) - (-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1) + (-(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q1) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q1))) + dq3*((-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*(-(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q2) - (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2)) + (-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q2) + (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1)) + (-(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*sin(q2) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2)*cos(q1))) + dq4*((-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*sin(q3)) + (-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7))*(-(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*sin(q3)) + (-(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7))*((-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100))) + dq5*((-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) - (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)) + (-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7))*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)) + (-(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7))*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100) - ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100))) + dq6*((-(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5)) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5)))*(-(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7)) + ((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5)) - (((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500))*(-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7)) + (-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*(-(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5)) + (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500))) + dq7*(((-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)))*(-(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7)) + (-(-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500) + (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)))*(-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7)) + (-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*((-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)))))/2 + (2*(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*(-dq1*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1) + dq2*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2) - dq2*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*cos(q2) - (-39*dq2*sin(q2)*cos(q4)/100 - 2*dq2*sin(q2)/5 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100 - 39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500)*sin(q1)*sin(q2) - (-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 2*dq1*sin(q2)*cos(q1)/5 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 - 2*dq2*sin(q1)*cos(q2)/5 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 - 39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500)*cos(q2)) + 2*(((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7))*(-dq1*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2) - dq2*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q2) + dq2*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*cos(q1)*cos(q2) + (-39*dq2*sin(q2)*cos(q4)/100 - 2*dq2*sin(q2)/5 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100 - 39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500)*sin(q2)*cos(q1) + (39*dq1*sin(q1)*sin(q2)*cos(q4)/100 + 2*dq1*sin(q1)*sin(q2)/5 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 - 2*dq2*cos(q1)*cos(q2)/5 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 - 39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)*cos(q2)) + 2*((((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7))*(dq1*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q2)*cos(q1) + dq1*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q1)*sin(q2) + dq2*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*cos(q2) - dq2*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q1)*cos(q2) + (39*dq1*sin(q1)*sin(q2)*cos(q4)/100 + 2*dq1*sin(q1)*sin(q2)/5 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 - 2*dq2*cos(q1)*cos(q2)/5 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 - 39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)*sin(q1)*sin(q2) - (-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 2*dq1*sin(q2)*cos(q1)/5 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 - 2*dq2*sin(q1)*cos(q2)/5 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 - 39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500)*sin(q2)*cos(q1)) + 2*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q2) + (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1))*(-dq7*((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + dq7*(-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) - dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*cos(q5) - (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*sin(q5))*sin(q7) + (-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6) + (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*cos(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*sin(q6))*cos(q7)) + 2*(-(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q2) - (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2))*(-dq7*((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + dq7*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) - dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5) - (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*sin(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*cos(q5))*sin(q7) + (-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6) + (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*cos(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*sin(q6))*cos(q7)) + 2*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*sin(q2) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2)*cos(q1))*(-dq7*(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + dq7*(-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7) + (-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*sin(q6) + (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*cos(q6))*cos(q7) + (-dq2*sin(q3)*cos(q2)*cos(q5) - dq3*sin(q2)*cos(q3)*cos(q5) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) + dq5*sin(q2)*sin(q3)*sin(q5) - (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*sin(q5))*sin(q7)))*(dq1*((((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*(39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 - 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 - 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 + 39*sin(q1)*sin(q2)*cos(q4)/100 + 2*sin(q1)*sin(q2)/5) + (((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)) + dq2*(-(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*cos(q1) - (((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1) + ((((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q1) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q1))) + dq3*((((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*(-(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q2) - (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2)) + (((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q2) + (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1)) + ((((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*sin(q2) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2)*cos(q1))) + dq4*((((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*sin(q3)) + (((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7))*(-(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*sin(q3)) + ((((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7))*((-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100))) + dq5*((((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) - (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)) + (((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7))*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)) + ((((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7))*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100) - ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100))) + dq6*((-(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5)) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5)))*((((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7)) + ((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5)) - (((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500))*(((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7)) + (((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*(-(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5)) + (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500))) + dq7*(((-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)))*((((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7)) + (-(-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500) + (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)))*(((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7)) + (((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*((-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)))))/2 + (2*(-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-dq1*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1) + dq2*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2) - dq2*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*cos(q2) - (-39*dq2*sin(q2)*cos(q4)/100 - 2*dq2*sin(q2)/5 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100 - 39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500)*sin(q1)*sin(q2) - (-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 2*dq1*sin(q2)*cos(q1)/5 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 - 2*dq2*sin(q1)*cos(q2)/5 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 - 39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500)*cos(q2)) + 2*(-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-dq1*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2) - dq2*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q2) + dq2*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*cos(q1)*cos(q2) + (-39*dq2*sin(q2)*cos(q4)/100 - 2*dq2*sin(q2)/5 + 39*dq2*sin(q4)*cos(q2)*cos(q3)/100 - 39*dq3*sin(q2)*sin(q3)*sin(q4)/100 + 39*dq4*sin(q2)*cos(q3)*cos(q4)/100 - 39*dq4*sin(q4)*cos(q2)/100 - 39*dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6)/500 - 39*dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6)/500 + 39*(-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6)/500 - 39*(-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)/500)*sin(q2)*cos(q1) + (39*dq1*sin(q1)*sin(q2)*cos(q4)/100 + 2*dq1*sin(q1)*sin(q2)/5 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 - 2*dq2*cos(q1)*cos(q2)/5 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 - 39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)*cos(q2)) + 2*(-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6))*(dq1*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q2)*cos(q1) + dq1*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q1)*sin(q2) + dq2*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*cos(q2) - dq2*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q1)*cos(q2) + (39*dq1*sin(q1)*sin(q2)*cos(q4)/100 + 2*dq1*sin(q1)*sin(q2)/5 - 39*dq2*cos(q1)*cos(q2)*cos(q4)/100 - 2*dq2*cos(q1)*cos(q2)/5 + 39*dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4)/100 + 39*dq4*sin(q2)*sin(q4)*cos(q1)/100 - 39*dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6)/500 - 39*dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6)/500 - 39*(-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6)/500 + 39*(dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)/500 + 39*(-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)*sin(q1)*sin(q2) - (-39*dq1*sin(q2)*cos(q1)*cos(q4)/100 - 2*dq1*sin(q2)*cos(q1)/5 - 39*dq2*sin(q1)*cos(q2)*cos(q4)/100 - 2*dq2*sin(q1)*cos(q2)/5 + 39*dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4)/100 + 39*dq4*sin(q1)*sin(q2)*sin(q4)/100 - 39*dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6)/500 - 39*dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6)/500 - 39*(-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6)/500 + 39*(-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4)/100 + 39*(-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)/500)*sin(q2)*cos(q1)) + 2*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q2) + (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1))*(-dq6*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) - dq6*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6) - (-dq5*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + dq5*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5) + (-dq1*sin(q1)*cos(q3) - dq1*sin(q3)*cos(q1)*cos(q2) + dq2*sin(q1)*sin(q2)*sin(q3) - dq3*sin(q1)*cos(q2)*cos(q3) - dq3*sin(q3)*cos(q1))*sin(q5) + (dq1*sin(q2)*sin(q4)*cos(q1) + dq2*sin(q1)*sin(q4)*cos(q2) - dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) + dq4*sin(q1)*sin(q2)*cos(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*cos(q4))*cos(q5))*sin(q6) + (-dq1*sin(q2)*cos(q1)*cos(q4) - dq2*sin(q1)*cos(q2)*cos(q4) + dq4*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + dq4*sin(q1)*sin(q2)*sin(q4) + (-dq1*sin(q1)*sin(q3) + dq1*cos(q1)*cos(q2)*cos(q3) - dq2*sin(q1)*sin(q2)*cos(q3) - dq3*sin(q1)*sin(q3)*cos(q2) + dq3*cos(q1)*cos(q3))*sin(q4))*cos(q6)) + 2*(-(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q2) - (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2))*(-dq6*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) - dq6*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6) - (-dq5*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + dq5*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5) + (-dq1*sin(q1)*sin(q2)*sin(q4) + dq2*sin(q4)*cos(q1)*cos(q2) - dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) + dq4*sin(q2)*cos(q1)*cos(q4) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*cos(q4))*cos(q5) + (dq1*sin(q1)*sin(q3)*cos(q2) - dq1*cos(q1)*cos(q3) + dq2*sin(q2)*sin(q3)*cos(q1) + dq3*sin(q1)*sin(q3) - dq3*cos(q1)*cos(q2)*cos(q3))*sin(q5))*sin(q6) + (dq1*sin(q1)*sin(q2)*cos(q4) - dq2*cos(q1)*cos(q2)*cos(q4) + dq4*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + dq4*sin(q2)*sin(q4)*cos(q1) + (-dq1*sin(q1)*cos(q2)*cos(q3) - dq1*sin(q3)*cos(q1) - dq2*sin(q2)*cos(q1)*cos(q3) - dq3*sin(q1)*cos(q3) - dq3*sin(q3)*cos(q1)*cos(q2))*sin(q4))*cos(q6)) + 2*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*sin(q2) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2)*cos(q1))*(-dq6*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) - dq6*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6) + (-dq2*sin(q2)*cos(q4) + dq2*sin(q4)*cos(q2)*cos(q3) - dq3*sin(q2)*sin(q3)*sin(q4) + dq4*sin(q2)*cos(q3)*cos(q4) - dq4*sin(q4)*cos(q2))*cos(q6) - (-dq2*sin(q3)*sin(q5)*cos(q2) - dq3*sin(q2)*sin(q5)*cos(q3) - dq5*(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - dq5*sin(q2)*sin(q3)*cos(q5) + (dq2*sin(q2)*sin(q4) + dq2*cos(q2)*cos(q3)*cos(q4) - dq3*sin(q2)*sin(q3)*cos(q4) - dq4*sin(q2)*sin(q4)*cos(q3) - dq4*cos(q2)*cos(q4))*cos(q5))*sin(q6)))*(dq1*((-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 - 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 - 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 + 39*sin(q1)*sin(q2)*cos(q4)/100 + 2*sin(q1)*sin(q2)/5) + (-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)) + dq2*(-(-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*cos(q1) - (-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1) + (-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q1) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q1))) + dq3*((-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q2) - (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2)) + (-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q2) + (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1)) + (-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*sin(q2) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2)*cos(q1))) + dq4*((-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*sin(q3)) + (-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*sin(q3)) + (-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6))*((-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100))) + dq5*((-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) - (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)) + (-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)) + (((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100) - ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100))*(-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6))) + dq6*((-(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5)) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5)))*(-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)) + ((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5)) - (((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500))*(-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)) + (-(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5)) + (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500))*(-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))) + dq7*(((-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)))*(-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)) + (-(-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500) + (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)))*(-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)) + ((-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)))*(-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))))/2 - (dq1*((-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*(39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 - 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 - 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 + 39*sin(q1)*sin(q2)*cos(q4)/100 + 2*sin(q1)*sin(q2)/5) + (-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)) + dq2*(-(-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*cos(q1) - (-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1) + (-(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q1) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q1))) + dq3*((-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*(-(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q2) - (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2)) + (-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q2) + (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1)) + (-(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*sin(q2) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2)*cos(q1))) + dq4*((-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*sin(q3)) + (-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7))*(-(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*sin(q3)) + (-(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7))*((-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100))) + dq5*((-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) - (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)) + (-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7))*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)) + (-(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7))*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100) - ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100))) + dq6*((-(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5)) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5)))*(-(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7)) + ((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5)) - (((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500))*(-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7)) + (-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*(-(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5)) + (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500))) + dq7*(((-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)))*(-(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7)) + (-(-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500) + (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)))*(-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7)) + (-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*((-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)))))*(2*dq1*((-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*(39*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*sin(q6)/500 - 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*cos(q6)/500 - 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)/100) + (-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7))*(-39*((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*sin(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*cos(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)/100) + (-(((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*cos(q6) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*sin(q6))*sin(q7) + ((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*cos(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5)*cos(q4))*cos(q7))*(39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 - 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 - 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 + 39*sin(q1)*sin(q2)*cos(q4)/100 + 2*sin(q1)*sin(q2)/5) + (-(((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*cos(q6) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*sin(q6))*sin(q7) + (-(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5)*cos(q4) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*cos(q5))*cos(q7))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)) + 2*dq2*(-(-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*(-39*(-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*sin(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)*cos(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)/100)*cos(q1) - (-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7))*(-39*(-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*sin(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)*cos(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)/100)*sin(q1) - (-(((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*cos(q6) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*sin(q6))*sin(q7) + ((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*cos(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5)*cos(q4))*cos(q7))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*cos(q1) + (-(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7))*((-39*((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*sin(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*cos(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)*cos(q1) + (-39*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*sin(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*cos(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)/100)*sin(q1)) - (-(((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*cos(q6) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*sin(q6))*sin(q7) + (-(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5)*cos(q4) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*cos(q5))*cos(q7))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1) + (-((-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*cos(q6) - sin(q2)*sin(q3)*sin(q4)*sin(q6))*sin(q7) + (sin(q2)*sin(q3)*sin(q5)*cos(q4) - sin(q2)*cos(q3)*cos(q5))*cos(q7))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q1) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q1))) + 2*dq3*((-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*(-(-39*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*sin(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*cos(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)/100)*cos(q2) - (-39*(-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*sin(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)*cos(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)/100)*sin(q1)*sin(q2)) + (-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7))*((-39*((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*sin(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*cos(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)*cos(q2) + (-39*(-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*sin(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)*cos(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)/100)*sin(q2)*cos(q1)) + (-(((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*cos(q6) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*sin(q6))*sin(q7) + ((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*cos(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5)*cos(q4))*cos(q7))*(-(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q2) - (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2)) + (-(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7))*((-39*((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*sin(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*cos(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)*sin(q1)*sin(q2) - (-39*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*sin(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*cos(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)/100)*sin(q2)*cos(q1)) + (-(((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*cos(q6) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*sin(q6))*sin(q7) + (-(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5)*cos(q4) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*cos(q5))*cos(q7))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q2) + (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1)) + (-((-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*cos(q6) - sin(q2)*sin(q3)*sin(q4)*sin(q6))*sin(q7) + (sin(q2)*sin(q3)*sin(q5)*cos(q4) - sin(q2)*cos(q3)*cos(q5))*cos(q7))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*sin(q2) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2)*cos(q1))) + 2*dq4*((-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*(-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*sin(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)*cos(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)/100) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) + (-39*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*sin(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*cos(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)/100)*sin(q2)*sin(q3) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*cos(q3)) + (-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7))*(-(sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*(-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*sin(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)*cos(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)/100) - (-39*((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*sin(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*cos(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)*sin(q2)*sin(q3) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*cos(q3)) + (-(((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*cos(q6) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*sin(q6))*sin(q7) + ((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*cos(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5)*cos(q4))*cos(q7))*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*sin(q3)) + (-(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7))*((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*sin(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*cos(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)/100) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*sin(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*cos(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)/100) - (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)) + (-(((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*cos(q6) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*sin(q6))*sin(q7) + (-(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5)*cos(q4) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*cos(q5))*cos(q7))*(-(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*sin(q3)) + (-((-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*cos(q6) - sin(q2)*sin(q3)*sin(q4)*sin(q6))*sin(q7) + (sin(q2)*sin(q3)*sin(q5)*cos(q4) - sin(q2)*cos(q3)*cos(q5))*cos(q7))*((-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100))) + 2*dq5*((-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-39*(-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*sin(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)*cos(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)/100) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)*sin(q4) - (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-39*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*sin(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*cos(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)/100) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*sin(q3)*sin(q4)) + (-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7))*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*(-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*sin(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)*cos(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)/100) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)*sin(q4) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-39*((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*sin(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*cos(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)/100) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*sin(q3)*sin(q4)) + (-(((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*cos(q6) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*sin(q6))*sin(q7) + ((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*cos(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5)*cos(q4))*cos(q7))*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) - (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)) + (-(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7))*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*sin(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*cos(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)/100) - ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-39*((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*sin(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*cos(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)/100) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q4) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q4)) + (((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100) - ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100))*(-((-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*cos(q6) - sin(q2)*sin(q3)*sin(q4)*sin(q6))*sin(q7) + (sin(q2)*sin(q3)*sin(q5)*cos(q4) - sin(q2)*cos(q3)*cos(q5))*cos(q7)) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100))*(-(((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*cos(q6) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*sin(q6))*sin(q7) + (-(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5)*cos(q4) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*cos(q5))*cos(q7))) + 2*dq6*((-(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5)) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5)))*(-((-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*cos(q6) - sin(q2)*sin(q3)*sin(q4)*sin(q6))*sin(q7) + (sin(q2)*sin(q3)*sin(q5)*cos(q4) - sin(q2)*cos(q3)*cos(q5))*cos(q7)) + ((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5)) - (((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500))*(-(((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*cos(q6) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*sin(q6))*sin(q7) + (-(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5)*cos(q4) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*cos(q5))*cos(q7)) + (-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*(-(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(-sin(q2)*sin(q3)*sin(q5)*cos(q4) + sin(q2)*cos(q3)*cos(q5)) + (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-39*(-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*sin(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)*cos(q6)/500) + (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500)*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5)*cos(q4) - (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*cos(q5)) - (-39*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*sin(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*cos(q6)/500)*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5))) + (-(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5)) + (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500))*(-(((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*cos(q6) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*sin(q6))*sin(q7) + ((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*cos(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5)*cos(q4))*cos(q7)) + (-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(-sin(q2)*sin(q3)*sin(q5)*cos(q4) + sin(q2)*cos(q3)*cos(q5)) - (((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-39*(-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*sin(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)*cos(q6)/500) + (-39*((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*sin(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*cos(q6)/500)*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5)) - (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500)*(-(sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5)*cos(q4))) + (-(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7))*(-(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5)*cos(q4) - (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*cos(q5)) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(-(sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5)*cos(q4)) + (((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-39*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*sin(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*cos(q6)/500) - (-39*((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*sin(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*cos(q6)/500)*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5)))) + 2*dq7*(((-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)))*(-((-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*cos(q6) - sin(q2)*sin(q3)*sin(q4)*sin(q6))*sin(q7) + (sin(q2)*sin(q3)*sin(q5)*cos(q4) - sin(q2)*cos(q3)*cos(q5))*cos(q7)) + (-(-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500) + (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)))*(-(((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*cos(q6) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*sin(q6))*sin(q7) + (-(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5)*cos(q4) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*cos(q5))*cos(q7)) + (-((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*sin(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*cos(q7))*((-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-39*(-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*sin(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)*cos(q6)/500) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(-(-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*sin(q6) - sin(q2)*sin(q3)*sin(q4)*cos(q6)) - (-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6))*(-39*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*sin(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*cos(q6)/500) + (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500)*(-((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*sin(q6) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*cos(q6))) + ((-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)))*(-(((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*cos(q6) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*sin(q6))*sin(q7) + ((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*cos(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5)*cos(q4))*cos(q7)) + (-((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*sin(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*cos(q7))*(-(-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*(-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*sin(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)*cos(q6)/500) + (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(-(-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*sin(q6) - sin(q2)*sin(q3)*sin(q4)*cos(q6)) - (-((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*sin(q6) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*cos(q6))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500) + (-39*((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*sin(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*cos(q6)/500)*(-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6))) + (-(((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*sin(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*cos(q7))*((-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*sin(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*cos(q6)/500) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(-((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*sin(q6) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*cos(q6)) - (-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-39*((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*sin(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*cos(q6)/500) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(-((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*sin(q6) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*cos(q6)))))/2 - (dq1*((((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*(39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 - 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 - 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 + 39*sin(q1)*sin(q2)*cos(q4)/100 + 2*sin(q1)*sin(q2)/5) + (((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)) + dq2*(-(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*cos(q1) - (((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1) + ((((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q1) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q1))) + dq3*((((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*(-(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q2) - (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2)) + (((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q2) + (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1)) + ((((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*sin(q2) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2)*cos(q1))) + dq4*((((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*sin(q3)) + (((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7))*(-(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*sin(q3)) + ((((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7))*((-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100))) + dq5*((((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) - (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)) + (((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7))*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)) + ((((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7))*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100) - ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100))) + dq6*((-(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5)) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5)))*((((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7)) + ((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5)) - (((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500))*(((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7)) + (((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*(-(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5)) + (((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500))) + dq7*(((-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)))*((((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7)) + (-(-(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500) + (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)))*(((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7)) + (((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*((-(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(-((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)))))*(2*dq1*((((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*(39*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*sin(q6)/500 - 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*cos(q6)/500 - 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)/100) + (((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7))*(-39*((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*sin(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*cos(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)/100) + ((((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*cos(q6) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*sin(q6))*cos(q7) + ((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*cos(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5)*cos(q4))*sin(q7))*(39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 - 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 - 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 + 39*sin(q1)*sin(q2)*cos(q4)/100 + 2*sin(q1)*sin(q2)/5) + ((((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*cos(q6) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*sin(q6))*cos(q7) + (-(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5)*cos(q4) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*cos(q5))*sin(q7))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)) + 2*dq2*(-(((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*(-39*(-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*sin(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)*cos(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)/100)*cos(q1) - (((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7))*(-39*(-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*sin(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)*cos(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)/100)*sin(q1) - ((((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*cos(q6) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*sin(q6))*cos(q7) + ((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*cos(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5)*cos(q4))*sin(q7))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*cos(q1) + ((((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7))*((-39*((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*sin(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*cos(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)*cos(q1) + (-39*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*sin(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*cos(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)/100)*sin(q1)) - ((((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*cos(q6) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*sin(q6))*cos(q7) + (-(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5)*cos(q4) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*cos(q5))*sin(q7))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1) + (((-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*cos(q6) - sin(q2)*sin(q3)*sin(q4)*sin(q6))*cos(q7) + (sin(q2)*sin(q3)*sin(q5)*cos(q4) - sin(q2)*cos(q3)*cos(q5))*sin(q7))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q1) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q1))) + 2*dq3*((((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*(-(-39*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*sin(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*cos(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)/100)*cos(q2) - (-39*(-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*sin(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)*cos(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)/100)*sin(q1)*sin(q2)) + (((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7))*((-39*((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*sin(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*cos(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)*cos(q2) + (-39*(-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*sin(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)*cos(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)/100)*sin(q2)*cos(q1)) + ((((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*cos(q6) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*sin(q6))*cos(q7) + ((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*cos(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5)*cos(q4))*sin(q7))*(-(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*cos(q2) - (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q1)*sin(q2)) + ((((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7))*((-39*((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*sin(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*cos(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)*sin(q1)*sin(q2) - (-39*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*sin(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*cos(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)/100)*sin(q2)*cos(q1)) + ((((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*cos(q6) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*sin(q6))*cos(q7) + (-(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5)*cos(q4) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*cos(q5))*sin(q7))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*cos(q2) + (-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100 + 2*cos(q2)/5)*sin(q2)*cos(q1)) + (((-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*cos(q6) - sin(q2)*sin(q3)*sin(q4)*sin(q6))*cos(q7) + (sin(q2)*sin(q3)*sin(q5)*cos(q4) - sin(q2)*cos(q3)*cos(q5))*sin(q7))*((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100 - 2*sin(q2)*cos(q1)/5)*sin(q1)*sin(q2) - (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100 - 2*sin(q1)*sin(q2)/5)*sin(q2)*cos(q1))) + 2*dq4*((((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*(-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*sin(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)*cos(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)/100) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) + (-39*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*sin(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*cos(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)/100)*sin(q2)*sin(q3) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*cos(q3)) + (((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7))*(-(sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*(-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*sin(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)*cos(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)/100) - (-39*((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*sin(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*cos(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)/100)*sin(q2)*sin(q3) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*cos(q3)) + ((((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*cos(q6) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*sin(q6))*cos(q7) + ((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*cos(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5)*cos(q4))*sin(q7))*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*sin(q3)) + ((((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7))*((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*sin(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*cos(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)/100) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*sin(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*cos(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)/100) - (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)) + ((((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*cos(q6) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*sin(q6))*cos(q7) + (-(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5)*cos(q4) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*cos(q5))*sin(q7))*(-(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*sin(q3)) + (((-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*cos(q6) - sin(q2)*sin(q3)*sin(q4)*sin(q6))*cos(q7) + (sin(q2)*sin(q3)*sin(q5)*cos(q4) - sin(q2)*cos(q3)*cos(q5))*sin(q7))*((-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100))) + 2*dq5*((((((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*cos(q6) + ((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*sin(q6))*cos(q7) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*sin(q7))*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-39*(-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*sin(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)*cos(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)/100) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)*sin(q4) - (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-39*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*sin(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*cos(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)/100) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q2)*sin(q3)*sin(q4)) + (((((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*cos(q6) + ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*sin(q6))*cos(q7) + (-((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5))*sin(q7))*(-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*(-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*sin(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)*cos(q6)/500 - 39*sin(q2)*sin(q3)*sin(q4)/100) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100)*sin(q4) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-39*((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*sin(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*cos(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)/100) - (-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q2)*sin(q3)*sin(q4)) + ((((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*cos(q6) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*sin(q6))*cos(q7) + ((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*cos(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5)*cos(q4))*sin(q7))*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) - (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)) + ((((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*cos(q6) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*sin(q6))*cos(q7) + (-(sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) - sin(q2)*sin(q3)*cos(q5))*sin(q7))*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*sin(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*cos(q6)/500 + 39*(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)/100) - ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-39*((sin(q1)*sin(q3) - cos(q1)*cos(q2)*cos(q3))*sin(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q4)*cos(q5))*sin(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)*cos(q6)/500 + 39*(-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q4)/100) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100)*sin(q4) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100)*sin(q4)) + (((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500 + 39*(sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4)/100 - 39*sin(q1)*sin(q2)*cos(q4)/100) - ((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100))*(((-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*cos(q6) - sin(q2)*sin(q3)*sin(q4)*sin(q6))*cos(q7) + (sin(q2)*sin(q3)*sin(q5)*cos(q4) - sin(q2)*cos(q3)*cos(q5))*sin(q7)) + (-((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500 + 39*sin(q2)*sin(q4)*cos(q3)/100 + 39*cos(q2)*cos(q4)/100) + (sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500 + 39*(-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4)/100 - 39*sin(q2)*cos(q1)*cos(q4)/100))*((((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*cos(q6) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*sin(q6))*cos(q7) + (-(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5)*cos(q4) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*cos(q5))*sin(q7))) + 2*dq6*((-(-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*sin(q5) - (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q5)) + (-39*(((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*cos(q4) + sin(q1)*sin(q2)*sin(q4))*cos(q5) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5))*sin(q6)/500 + 39*((sin(q1)*cos(q2)*cos(q3) + sin(q3)*cos(q1))*sin(q4) - sin(q1)*sin(q2)*cos(q4))*cos(q6)/500)*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5)))*(((-sin(q2)*sin(q3)*cos(q4)*cos(q5) - sin(q2)*sin(q5)*cos(q3))*cos(q6) - sin(q2)*sin(q3)*sin(q4)*sin(q6))*cos(q7) + (sin(q2)*sin(q3)*sin(q5)*cos(q4) - sin(q2)*cos(q3)*cos(q5))*sin(q7)) + ((-39*(((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*cos(q5) + (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*sin(q5))*sin(q6)/500 + 39*((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*sin(q4) - sin(q2)*cos(q1)*cos(q4))*cos(q6)/500)*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*sin(q5) + sin(q2)*sin(q3)*cos(q5)) - (((-sin(q1)*sin(q3) + cos(q1)*cos(q2)*cos(q3))*cos(q4) + sin(q2)*sin(q4)*cos(q1))*sin(q5) - (-sin(q1)*cos(q3) - sin(q3)*cos(q1)*cos(q2))*cos(q5))*(-39*((sin(q2)*cos(q3)*cos(q4) - sin(q4)*cos(q2))*cos(q5) - sin(q2)*sin(q3)*sin(q5))*sin(q6)/500 + 39*(sin(q2)*sin(q4)*cos(q3) + cos(q2)*cos(q4))*cos(q6)/500))*((((-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*cos(q4)*cos(q5) + (-sin(q1)*cos(q2)*cos(q3) - sin(q3)*cos(q1))*sin(q5))*cos(q6) + (-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q4)*sin(q6))*cos(q7) + (-(-sin(q1)*sin(q3)*cos(q2) + cos(q1)*cos(q3))*sin(q5)*cos(q4) + (-sin(q1)*cos(q2)*cos(q3) - sin