Wrench.gravity_compensated

Wrench.gravity_compensated(ft_sensor_frame, mass, center_of_mass)[source]

Removes the force and torque in effect of gravity from the wrench.

Parameters

ft_sensor_frame (compas.geometry.Frame) – The coordinate frame of the force torque sensor.
mass (float) – The mass of the object in kg.
center_of_mass (Point) – The center of mass of the object in meters.

Returns

Wrench – The gravity compensated wrench.

Examples

>>> mass, com = 10, [0, 0, 1]
>>> f = Frame([0, 0, 0], [1, 0, 0], [0, 1, 0])
>>> w = Wrench([0, 0, -98], [0, 0, 0])
>>> w.gravity_compensated(f, mass, com)
Wrench(Vector(0.000, 0.000, 0.066), Vector(0.000, 0.000, 0.000))

>>> mass, com = 10, [1, 1, 1]
>>> f = Frame([0, 0, 0], [1, 0, 0], [0, 1, 0])
>>> w = Wrench([0, 0, -98], [-98, 98, 0])
>>> w.gravity_compensated(f, mass, com)
Wrench(Vector(0.000, 0.000, 0.066), Vector(-88.193, 88.193, 0.000))

Notes

For more info, see 1.

References

1: Vougioukas S., Bias Estimation and Gravity Compensation For Force-Torque Sensors, Available at: https://www.semanticscholar.org/paper/Bias-Estimation-and-Gravity-Compensation-For-Vougioukas/900c5de4ac54cf28df816584264fa0de71c4817f

Wrench.gravity_compensated

COMPAS