gh2HpHm=-(cb^2*(L3*R21*v1 + IL5*R23*sb*v1 + L2*R22*v2)) - 
 sb^2*(L1*R21*v1 + L3*R22*v2) + cb*sb*(L4*R22*v1 + R22*RL5*v1 + L4*R21*v2 + 
   R21*RL5*v2 - IL5*R23*sb*v2)
