Input link mass m, arm length L, pose angle θ, and gravitational acceleration g, compute required gravity-compensation torque τ = m·g·L·cosθ for robot-arm torque-feedforward control.
输入质量 m、臂长 L、角度 θ、g，求关节重力扭矩。