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，求關節重力扭矩。