gh1HpHm=-(cb^2*(L3*R11*v1 + IL5*R13*sb*v1 + L2*R12*v2)) - 
 sb^2*(L1*R11*v1 + L3*R12*v2) + cb*sb*(L4*R12*v1 + R12*RL5*v1 + L4*R11*v2 + 
   R11*RL5*v2 - IL5*R13*sb*v2)
