KR20210002278A - Force/torque sensor capable of auto calibration and auto calibration method - Google Patents

Abstract

The present invention relates to a force/torque sensor capable of auto calibration and an auto calibration method. According to the present invention, the force/torque sensor comprises: a first sensor unit for measuring triaxial force and triaxial torque; a second sensor unit for measuring the triaxial acceleration, triaxial gyro, and triaxial compass; and a calculating unit providing a value obtained by subtracting a force/torque value due to the weight of a tool attached to the force/torque sensor from a force/torque value measured by the first sensor unit as a measured force/torque value.

Description

6-axis force/torque sensor capable of automatic calibration and automatic calibration method {FORCE/TORQUE SENSOR CAPABLE OF AUTO CALIBRATION AND AUTO CALIBRATION METHOD}

The present invention relates to a six-axis force/torque sensor. More specifically, the present invention relates to a six-axis force/torque sensor capable of auto-calibration and an auto-calibration method that eliminates the influence of the weight of a tool attached to the sensor.

The 6-axis force/torque sensor can measure external forces (3-axis force and 3-axis torque) acting on the sensor. A six-axis force/torque sensor such as Patent No. 10-1477120 is placed at the end of a robot, for example a manipulator as shown in FIG. 1, and various tools (grippers, etc.) as shown in FIG. 2 are placed at the front end thereof. By attaching it, it became possible to perform many tasks that were not possible only with the existing position control.

However, even if no external force is applied to the 6-axis force/torque sensor, the force/torque due to the weight of the tool attached to the front end of the sensor affects the measured value of the sensor, making it difficult to perform precise work using the 6-axis force/torque sensor. Is causing.

Therefore, in the case of the conventional 6-axis force/torque sensor, the weight and center of gravity of the tool attached to the sensor are known in advance, and the value of the rotation matrix at the end of the robot and the weight and center of gravity of the tool are used. The 6-axis force/torque value was obtained, and then the 6-axis force/torque value applied by the device was removed from the measured value of the 6-axis force/torque sensor.

However, this method requires knowing the weight and center of gravity of the tool in advance, but it is difficult to apply to all tools because it is impossible to calculate the effect of the change of the center of gravity due to assembly.

In addition, since the rotation matrix at the end of the robot is removed through calculation every time, there is a problem of lowering the calculation speed of the calculation unit (main controller).

An object of the present invention is to provide a force/torque sensor capable of auto-calibration and an auto-calibration method.

Another object of the present invention is to provide a force/torque sensor and an auto calibration method capable of auto-calibration by deriving a force/torque due to the weight of a tool through measurement values of the first sensor unit and the second sensor unit.

Another object of the present invention is to provide a force/torque sensor and an auto-calibration method capable of auto-calibration by continuously using the force/torque by the weight of the tool once derived until the tool is replaced.

The above and other objects of the present invention can be achieved both by the force/torque sensor capable of auto-calibration and the auto-calibration method according to the present invention.

The force/torque sensor capable of auto-calibration according to the present invention includes: a first sensor unit for measuring a three-axis force and a three-axis torque; A second sensor unit that measures 3-axis acceleration, 3-axis gyro, and 3-axis compass; And a calculating unit that provides a value obtained by removing the force/torque value due to the weight of the tool attached to the force/torque sensor from the force/torque measurement value by the first sensor unit as the measured force/torque value. do.

The second sensor unit may be formed of an IMU (Inertial Measurement Unit) sensor.

The first sensor unit includes a deformable region in which the position is deformed according to the movement of the tool and a fixed region in which the position is not deformed according to the movement of the tool. The three-axis force and the three-axis torque are measured by a change in capacitance between the two electrode parts, and the second sensor part is located in the fixed area.

The calculation unit may calculate a force/torque value due to the weight of the tool by using the force/torque measurement value by the first sensor unit and the measurement value by the second sensor unit.

The calculation unit may remove the force/torque value due to the weight of the tool attached to the force/torque sensor from the force/torque measurement value by the first sensor unit using the following equation.

는 도구의 무게중심 벡터(P_T)에 대한 대칭행렬, F_WT는 도구의 무게중심에서의 힘, τ_WT는 도구의 무게중심에서의 토크이다.Here, F _GC is the weight compensated force, τ _GC is the weight compensated torque, F _WS is the force measured by the first sensor unit, τ _WS is the torque measured by the first sensor unit, and R _ST is the sensor frame. Rotation matrix to the tool frame,

Is the symmetric matrix about the tool's center of gravity vector (P _T ), F _WT is the force at the tool's center of gravity, and τ _WT is the torque at the tool's center of gravity.

는 상기 도구의 무게에 의한 힘,

는 상기 도구의 무게에 의한 토크이다.In the above formula

Is the force by the weight of the tool,

Is the torque by the weight of the tool.

The calculation unit calculates the force/torque value by the weight of the tool, stores the calculated result value, and measures the force/torque value measured by the force/torque sensor by the first sensor unit when providing the force/torque value measured by the force/torque sensor. It can be provided by removing the force/torque value by the weight of the stored tool from the stored force/torque value.

An auto calibration method according to an embodiment of the present invention includes a sensor attaching step of attaching the force/torque sensor according to claim 1 to one end of a robot; A tool connecting step of connecting a first tool to the force/torque sensor; Using the measured values measured by the first sensor unit and the second sensor unit of the force/torque sensor in a state in which no external force other than gravity is applied to the first tool, the calculation unit of the force/torque sensor A first force/torque value calculating step of calculating a first force/torque value by weight; A first force/torque value storing step of storing the calculated first force/torque value; And a sensing value derivation step of deriving a value obtained by removing the first force/torque value from the force/torque value by the first sensor unit as a sensing value of the force/torque sensor with respect to the external force applied to the first tool. Including.

In addition, a tool replacement step of replacing the first tool with a second tool; Using the measured values measured by the first sensor unit and the second sensor unit of the force/torque sensor in a state in which no external force other than gravity is applied to the second tool, the calculation unit of the force/torque sensor A second force/torque value calculating step of calculating a second force/torque value by weight; And a second force/torque value storing step of storing the calculated second force/torque value, wherein the second force/torque value is removed instead of the first force/torque value in the sensing value providing step. Can be provided as a sensing value.

로 연산하고, 도구의 무게에 의한 토크는

로 연산하며, 여기서 R_ST는 센서 프레임에서 도구 프레임으로의 회전행렬,

는 도구의 무게중심 벡터(P_T)에 대한 대칭행렬, F_WT는 도구의 무게중심에서의 힘, τ_WT는 도구의 무게중심에서의 토크이다.The force by the weight of the tool is

And the torque by the weight of the tool is

Where R _ST is the rotation matrix from the sensor frame to the tool frame,

Is the symmetric matrix about the tool's center of gravity vector (P _T ), F _WT is the force at the tool's center of gravity, and τ _WT is the torque at the tool's center of gravity.

The force/torque sensor and auto-calibration method capable of auto-calibration of the present invention, after assembling the tool to the sensor, derives the weight and center of gravity of the tool through the measured values of the first sensor unit and the second sensor unit, and uses this for auto calibration. It is possible to perform accurate auto-calibration taking into account the effect of the tool assembly process, and it is characterized in that auto-calibration is possible by continuously using the weight and center of gravity of the tool once derived until the tool is replaced.

1 is a diagram showing an exemplary manipulator.
2 is a diagram showing various devices that can be attached to the end of a manipulator.
3 is a block diagram of a force/torque sensor capable of auto calibration according to the present invention.
4 is a perspective view of a force/torque sensor according to an embodiment of the present invention.
5 is an exploded perspective view of a force/torque sensor according to an embodiment of the present invention.
6 is a view showing the structure and movement of the deformation plate of the force / torque sensor according to an embodiment of the present invention.
7 is a diagram showing an arrangement relationship between an electrode on a PCB and a sensing plate.
8 is a diagram illustrating an exemplary position of a second sensor unit.
9 is a diagram showing a relationship between a base frame, a sensor frame, and a tool frame.
10 is a flowchart of an auto calibration method according to an embodiment of the present invention.
11 and 12 are views showing reference data using already known values, measurement data by a first sensor unit, and auto-calibrated data of the present invention.

Hereinafter, a force/torque sensor according to the present invention will be described in detail with reference to the accompanying drawings.

In the following description, only portions necessary to understand the force/torque sensor according to the exemplary embodiment of the present invention are described, and descriptions of other portions may be omitted so as not to distract the gist of the present invention.

In addition, terms or words used in the present specification and claims described below should not be construed as being limited to conventional or dictionary meanings, and meanings consistent with the technical idea of the present invention so that the present invention can be most appropriately expressed. And should be interpreted as a concept.

Throughout the specification, when a part "includes" a certain component, it means that other components may be further included rather than excluding other components unless otherwise stated.

In various embodiments, components having the same configuration will be representatively described in one embodiment by using the same reference numerals, and in other embodiments, configurations different from the one embodiment will be described.

3 is a block diagram of a six-axis force/torque sensor according to the present invention.

As shown in FIG. 3, the six-axis force/torque sensor 100 according to the present invention includes a first sensor unit 10, a second sensor unit 20, an operation unit 30, and a storage unit 40. Can be done.

The first sensor unit 10 measures an external force applied to the 6-axis force/torque sensor 100 according to the present invention.

The first sensor unit 10 can measure the force of the three axes (X, Y, Z axes) and the torque on the three axes (X, Y, Z axes), and the present invention having such a first sensor unit The force/torque sensor of is a 6-axis force/torque sensor that can detect the force applied in the direction of three axes and the torque around the three axes and provide the detected values.

The six-axis force/torque sensor 100 according to the present invention includes a moving area A whose position is changed according to the movement of the attached tool 200 and a fixed area B whose position is not changed according to the movement of the tool. The first sensor unit may be configured to face each other and measure a force/torque acting on the tool due to a change in capacitance between the first electrode located in the moving area and the second electrode located in the fixed area.

Next, the second sensor unit 20 is composed of a sensor capable of measuring a 3-axis acceleration, a 3-axis gyro, and a 3-axis compass. As such a sensor, an IMU (Inertial Measurement Unit) sensor may be used.

The second sensor unit may detect the overall movement or position of the 6-axis force/torque sensor 100 according to the present invention, and the second sensor unit may be located in, for example, a fixed area of the first sensor unit. Here, being positioned in the fixed area of the first sensor unit means that it is located in a place not affected by the movement of the tool 200, but does not necessarily mean that the first sensor unit must be directly connected to the fixed area.

Next, the calculation unit 30 calculates the 3-axis force and 3-axis torque values sensed by the 6-axis force/torque sensor according to the present invention and provides the result. To this end, the calculation unit 30 calculates the change in capacitance between the first electrode and the second electrode of the first sensor unit 10 and converts the result to a tool attached to the front end of the six-axis force/torque sensor according to the present invention. It is provided as a sensing value for the applied external force (force/torque).

At this time, even if an external force does not act on the tool 200 connected to the front end of the 6-axis force/torque sensor 100 according to the present invention, force/torque occurs due to the weight of the tool 200, and force/torque due to the weight of the tool Affects the sensing value of the sensor.

Accordingly, the calculation unit 30 of the six-axis force/torque sensor according to the present invention calculates the sensed force/torque value by removing the force/torque value due to the weight of the tool 200 from the force/torque measurement value by the first sensor unit. By providing it as a value, it is possible to accurately detect the external force acting on the tool 200, thereby enabling precise work using the tool.

To this end, the calculation unit 30 calculates the force/torque value by the weight of the tool 200 using the force/torque measurement value by the first sensor unit 10 and the measurement value by the second sensor unit 20 do.

In addition, the force/torque value by the weight of the tool once measured is stored in the storage unit 40, and in subsequent calculations, the force/torque value by the weight of the tool stored in the force/torque measurement value by the first sensor unit Can be removed and the result can be output as a sensing value of the 6-axis force/torque sensor according to the present invention.

Then, when replacing the tool 200 connected to the front end of the six-axis force/torque sensor according to the present invention with another tool 200 ′, the operation unit 30 is a force/power by the weight of the replaced tool 200 ′. The torque value is recalculated and stored in the storage unit 40, and in subsequent calculations, the force/torque value due to the weight of the replaced tool 200' is removed using the newly stored value. Force/torque sensing values can be provided.

An embodiment implementing the six-axis force/torque sensor 100 according to the present invention is illustrated in FIGS. 4 to 7.

The six-axis force/torque sensor 100 according to an embodiment of the present invention will be described in more detail with reference to FIGS. 4 to 7 as follows.

4 is a perspective view of a six-axis force/torque sensor 100 according to an embodiment of the present invention, and FIG. 5 is an exploded perspective view.

As shown in Figure 5, the six-axis force/torque sensor 100 according to an embodiment of the present invention includes an upper plate 1, a deformation plate 2, a sensing plate 3, a PCB 4, and a lower plate. (5) can be included.

The 6-axis force/torque sensor 100 according to an embodiment of the present invention shows a deformation plate 2, a sensing plate 3, and a PCB 4 between the upper plate 1 and the lower plate 5 in FIG. 5. It can be completed by a simple assembling method of sequentially stacking and connecting as shown in.

At this time, the central region 2-1 of the deformable plate 2 as shown in FIG. 6 may be connected to the tool 200 through a hole H formed in the upper plate 1. Accordingly, the central area 2-1 is a moving area A that can move integrally with the tool 200.

On the other hand, the outer circumferential region 2-2 of the deformable plate 2 is a fixed region B that is connected to the central region 2-1 and the elastic hinge 2-3, which is not interlocked with the movement of the tool.

Therefore, when assembling the 6-axis force/torque sensor 100 according to an embodiment of the present invention, the sensing plate 3 is connected to the center area 2-1 of the deformation plate 2 and the PCB 4 is connected to the deformation plate. When connected to the outer circumferential area 2-2 of (2), the distance between the sensing plate 3 and the electrode 4-1 on the PCB 4 is caused by the movement of the tool 200 as shown in FIG. 7. It varies, and the capacitance generated between the sensing plate 3 and the electrode 4-1 on the PCB changes.

Accordingly, the main controller located on the PCB 4 can calculate the force/torque applied to the tool 200 using this change in capacitance.

In addition, the 6-axis force/torque sensor 100 according to an embodiment of the present invention may include an IMU sensor 4-2 on the PCB 4 corresponding to the fixed area B as shown in FIG. 8. And, by using the sensing value by the IMU sensor, the main controller can calculate the force/torque by the weight of the tool 200 connected to the front end of the six-axis force/torque sensor 100 according to an embodiment of the present invention. .

A method of calculating the force/torque due to the weight of the tool 200 using the sensing value by the IMU sensor will be described in more detail as follows.

First, for explanation, as shown in FIG. 9, a coordinate system having a base on which a robot is positioned as an origin is a base frame {B}, a coordinate system having a sensor 100 as an origin is a sensor frame {S}, and the tool 200 is The coordinate system with the center of gravity as the origin is called the tool frame {T}. Here, the tool frame {T} is a coordinate system in which one axis (Z' axis) always faces the direction of gravity rather than changing according to the movement of the tool 200, and is the same coordinate system as the base frame.

R _BS is the rotation matrix from the base frame {B} to the sensor frame {S}, R _BT is the rotation matrix from the base frame {B} to the tool frame {T}, and R _ST is the sensor frame {S} to the tool frame{ Is the rotation matrix to T}, where R _ST is R _BT = It must be a rotation matrix that can satisfy the relationship of R _{BS ·} R _ST .

Base frame {B} and tool frame {T} are in the same coordinate system, so R _ST = R ^T _{BS ·} I, and in the present invention, since R _BS can be calculated using the sensing value by the IMU sensor, the rotation matrix R _ST can be obtained in conclusion, and the force and torque due to the weight of the tool can be calculated using this. As a result, it is possible to provide a sensing value for the pure external force by removing the torque and force caused by the weight of the tool.

This is described in more detail as follows.

First, to derive the rotation matrix R _BS using the sensing value by the IMU sensor, the roll and pitch angles using the acceleration value are derived. Here, Ax, Ay, and Az are acceleration values in the X, Y, and Z axes.

Then, the roll and pitch angles are derived using the gyro value. Here, Gx, Gy, Gz are the gyro values of the X, Y, and Z axes.

Apply the complementary filter to derive the roll and pitch angles, and use them to derive the yaw angle. Here, the values of α and β are constant values determined by the filter.

Then, the rotation matrix R _BS is derived using the derived roll, pitch, and yaw angle.

9, when the tool 200 is installed at the front end of the force/torque sensor 100 according to an embodiment of the present invention, the force/torque by the weight of the tool 200 measured in the sensor frame {S} Is as follows.

Here, F _WSO is the force measured by the first sensor unit, τ _WSO is the torque measured by the first sensor unit, and the force torque at the tool frame {T} with the center of mass of the tool 200 as the origin is It is as follows (Z' axis is the direction of gravity).

And the force/torque in the sensor frame {S} and the tool frame {T} has the following relationship.

는 도구의 무게중심 벡터(P_T)에 대한 대칭행렬이다.here

Is the symmetric matrix about the tool's center of gravity vector (P _T ).

Therefore, it can be seen that the weight (m _t ) of the tool can be calculated through the force/torque value measured by the first sensor unit and the measured value of the second sensor unit by using the following relationship.

In addition, it can be seen that the center of gravity can be calculated through the force/torque value measured by the first sensor unit and the measured value by the second sensor unit by using the relationship below. That is, R _ST , R _BS , F _WSO , τ _WSO are values that can be known from the force/torque values measured by the first sensor unit and the measured values of the second sensor unit, so that the tool's center of gravity vector P _T can be derived. .

Therefore, in conclusion, the compensated (auto-calibrated) force by removing the force and torque due to the weight of the tool can be derived by the equation (1) below, and the torque by equation (2) below.

Equation (1):

Equation (2):

는 도구의 무게에 의한 힘,

는 도구의 무게에 의한 토크이다. Here, F _WS is the force measured by the first sensor unit, τ _WS is the torque measured by the first sensor unit,

Is the force by the weight of the tool,

Is the torque due to the weight of the tool.

Therefore, when the calculation unit calculates the force/torque value by the weight of the tool 200, stores the calculated result value in the storage unit, and provides the force/torque value measured by the force/torque sensor according to the present invention. Force/torque compensated for the force/torque due to the weight of the tool without the need to perform complex calculations each time by removing and providing the force/torque value due to the weight of the tool stored from the force/torque value measured by the first sensor unit Measures can be provided.

10 is a flowchart of an auto calibration method according to an embodiment of the present invention.

Referring to FIG. 10, it will be described once again how to perform auto calibration using the force/torque sensor according to the present invention. However, descriptions overlapping with the previous description will be omitted and replaced with the previous description for clarity.

First, the six-axis force/torque sensor 100 according to an embodiment of the present invention is attached to the robot (S10).

Then, a tool 200 such as a gripper is connected to one end of the six-axis force/torque sensor 100 according to an embodiment of the present invention (S20).

Through the assembly of steps S10 and S20, since the robot can know the 6-axis force/torque received by the tool installed at the end, it can perform precision work using the tool.

However, the force/torque value by the weight of the tool 200 is included in the force/torque value by the 6-axis force/torque sensor 100, which interferes with accurate measurement of the external force actually applied to the tool.

Accordingly, the auto calibration method according to an embodiment of the present invention uses the measured values measured by the first sensor unit 10 and the second sensor unit 20 of the 6-axis force/torque sensor according to an embodiment of the present invention. Thus, the calculation unit 30 calculates a force/torque value based on the weight of the tool (S30).

Then, the calculated force/torque value is stored in the storage unit 40 (S40).

When an external force acts on the tool 200, the calculation unit 30 uses the first sensor unit 10 as a sensing value of the six-axis force/torque sensor according to an embodiment of the present invention for the external force applied to the first tool 200. A value obtained by removing the stored force/torque value by the weight of the tool from the force/torque value by) is provided (S50).

Then, the auto-calibration method according to an embodiment of the present invention determines whether the tool has been replaced in step S60, and if the tool has not been replaced, the auto-calibrated force by using the force/torque value by the weight of the tool continuously stored. /Provides a torque value.

However, if it is determined that the tool has been replaced in step S60, it returns to step S30 and calculates the force/torque value by the weight of the replaced tool, stores the calculated force/torque value (S40), and derives subsequent sensing values. In the step, auto calibration is performed to remove the force/torque value by the weight of the newly stored and replaced tool from the measured force/torque value.

In order to confirm the effect of the present invention, the reference data calculated by the weight and center of gravity of the tool known in advance, the rotation matrix from the robot arm, and the force/torque value measured by the first sensor unit, the present invention The corresponding force/torque values were compared.

As a result, it can be confirmed that the force measured by the first sensor unit (measured data in Fig. 11) as shown in Fig. 11 contains a lot of noise due to the influence of the weight of the tool in the Z-axis force of the reference data. have. On the other hand, it was confirmed that the data of the present invention, which removed the effect of the weight of the tool, showed similar values to the reference data in the Z-axis force.

In addition, in terms of torque, it was confirmed that the data according to the present invention exhibited similar values to the reference data compared to the torque measured by the first sensor unit (measured data in FIG. 12) as shown in FIG. 12.

So far, a six-axis force/torque sensor capable of auto-calibration according to an embodiment of the present invention and an auto-calibration method have been described with reference to specific embodiments. However, the present invention is not limited to these specific embodiments, and it should be understood that various changes and modifications may be made without departing from the spirit and scope of the invention claimed in the claims.

1: upper plate 2: deformation plate
3: sensing plate 2-1: center area
2-2: outer circumferential area 2-3: elastic hinge
4: PCB 4-1: electrode
4-2: IMU sensor 5: lower plate
10: first sensor unit 20: second sensor unit
30: operation unit 40: storage unit
100: 6-axis force/torque sensor capable of auto calibration
200, 200': Tool H: Hole

Claims (10)

A first sensor unit that measures a 3-axis force and a 3-axis torque;
A second sensor unit that measures 3-axis acceleration, 3-axis gyro, and 3-axis compass; And
An operation unit configured to provide a value obtained by removing the force/torque value by the weight of the tool attached to the force/torque sensor from the force/torque measurement value by the first sensor unit as the measured force/torque value;
Force / torque sensor capable of auto-calibration, characterized in that it comprises a. The method of claim 1,
The force/torque sensor capable of auto-calibration, wherein the second sensor unit is formed of an IMU (Inertial Measurement Unit) sensor. The method of claim 1,
The first sensor unit includes a deformable region in which the position is deformed according to the movement of the tool and a fixed region in which the position is not deformed according to the movement of the tool, and the first electrode unit located in the deformable region and the fixed region are The three-axis force and the three-axis torque are measured as a change in capacitance between the second electrode parts,
The force/torque sensor capable of auto-calibration, wherein the second sensor unit is located in the fixed area. The method according to any one of claims 1 to 3,
The calculation unit calculates a force/torque value due to the weight of the tool using the force/torque measurement value by the first sensor unit and the measurement value by the second sensor unit. /Torque sensor. The method of claim 4,
The calculation unit removes the force/torque value due to the weight of the tool attached to the force/torque sensor from the force/torque measurement value by the first sensor unit using the following equation. Torque sensor.

Here, F _GC is the weight compensated force, τ _GC is the weight compensated torque, F _WS is the force measured by the first sensor unit, τ _WS is the torque measured by the first sensor unit, and R _ST is the sensor frame. Rotation matrix to the tool frame,

Is the symmetric matrix about the tool's center of gravity vector (P _T ), F _WT is the force at the tool's center of gravity, and τ _WT is the torque at the tool's center of gravity. The method of claim 5,
In the above formula

Is the force by the weight of the tool,

Is a force/torque sensor capable of auto-calibration, characterized in that the torque by the weight of the tool. The method of claim 6,
The calculation unit calculates the force/torque value by the weight of the tool, stores the calculated result value, and measures the force/torque value measured by the force/torque sensor by the first sensor unit when providing the force/torque value measured by the force/torque sensor. Force/torque sensor capable of auto-calibration, characterized in that the force/torque value by the weight of the stored tool is removed from the stored force/torque value and provided. A sensor attaching step of attaching the force/torque sensor according to claim 1 to one end of the robot;
A tool connecting step of connecting a first tool to the force/torque sensor;
Using the measured values measured by the first sensor unit and the second sensor unit of the force/torque sensor in a state in which no external force other than gravity is applied to the first tool, the calculation unit of the force/torque sensor A first force/torque value calculating step of calculating a first force/torque value by weight;
A first force/torque value storing step of storing the calculated first force/torque value; And
A sensing value derivation step of deriving a value obtained by removing the first force/torque value from the force/torque value by the first sensor unit as a sensing value of the force/torque sensor with respect to an external force applied to the first tool;
Auto calibration method comprising a. The method of claim 8,
A tool replacement step of replacing the first tool with a second tool;
Using the measured values measured by the first sensor unit and the second sensor unit of the force/torque sensor in a state in which no external force other than gravity is applied to the second tool, the calculation unit of the force/torque sensor A second force/torque value calculating step of calculating a second force/torque value by weight; And
A second force/torque value storing step of storing the calculated second force/torque value;
Including more,
In the step of providing the sensing value, a value obtained by removing the second force/torque value instead of the first force/torque value is provided as a sensing value. The method according to claim 8 or 9,
The force by the weight of the tool is

And the torque by the weight of the tool is

Where R _ST is the rotation matrix from the sensor frame to the tool frame,

Is a symmetric matrix about the tool's center of gravity vector (P _T ), F _WT is the force at the tool's center of gravity, and τ _WT is the torque at the tool's center of gravity.

Images