KR101086364B1 - Robot parameter estimation method using Kalman filter - Google Patents

Abstract

A method and system for estimating robot kinematic parameters using Kalman filter is disclosed. A method of estimating kinematic parameters for controlling a robot, the method comprising: obtaining measured value information about a posture of the robot from a measurement system; Acquiring static kinematic modeling result information using the static kinematic modeling equation for the robot; And estimating a kinematic parameter of the robot by applying a Kalman filter based on the measured value information and the static kinematic modeling result information and considering the measured value information and the noise component included in the modeling of the robot. A robot kinematic variable estimation method is provided. This makes it possible to implement a robot kinematics parameter estimation method that is robust to sensor noise in measurement systems and uncertainties in kinematic modeling.

Kalman Filter, Modeling Noise, Sensor Noise, POE

Description

Robot parameter estimation method and system using Kalman filter {Robot parameter estimation method using Kalman filter}

The present invention relates to a method and system for estimating robot kinematic parameters using Kalman filter.

The control technology of the robotic system used for welding automation in shipbuilding process is making great progress. Obstacles to the precise control of these robotic systems (manipulators) include kinematic parameter errors, tolerances in machining, and misalignment of connected components. These disturbances make it difficult to accurately position end-effectors such as electrodes located at one end of the robotic system.

Various calibration methods have been applied to minimize the position control error caused by the aforementioned factors. The correction methods according to the prior art have been applied to the kinematic variable estimation method to obtain the information on the position and attitude of the robot system through the measurement system, and to minimize the error by comparing the obtained information with the results of the robot kinematic equation.

According to this, the position and attitude error of the robot is obtained by comparing the signal in the measurement system with the result of the robot static kinematic equation, and the kinematic variable is estimated by applying the robot kinematic variable estimation algorithm. By using the estimated kinematic variables, the position and attitude of the robot tip are corrected to implement the desired robot attitude control.

Limitations and problems of the conventional robot kinematic variable estimation algorithm are as follows. In the conventional robot kinematic variable estimation algorithm, the noise component of the measurement system and the modeling error (noise) of the robot static kinematic equation are not considered. By not considering these factors, the reliability of the kinematic variable estimation is degraded when the optimal value is obtained through iterative computation.

In addition, the noise of the measurement system is a factor that hinders the convergence of the instrument variables, and it is difficult to estimate the exact value, and in addition to the kinematic factors, the accuracy of the estimated value is degraded due to the influence of backlash and controller performance. .

Therefore, in the estimation of robot kinematics variables, development of a method for estimating robot kinematics variables that takes into account the uncertainty of the sensor noise component and the kinematics model of the measurement system is required.

The present invention provides a method and system for estimating a robot kinematics parameter applying a Kalman filter that takes into account the noise of the measurement system and the robot kinematic modeling noise with respect to the attitude control of the robot.

According to an aspect of the present invention, a method for estimating kinematic parameters for the attitude control of the robot, comprising the steps of: obtaining measurement value information about the attitude of the robot from a measurement system; Acquiring static kinematic modeling result information using the static kinematic modeling equation for the robot; And estimating a kinematic parameter of the robot by applying a Kalman filter based on the measured value information and the static kinematic modeling result information and considering the measured value information and the noise component included in the modeling of the robot. A robot kinematic variable estimation method is provided.

According to another aspect of the present invention, a kinematic variable estimation system for controlling the attitude of the robot, comprising: a measurement value information acquisition unit for obtaining measurement value information from the measurement system of the robot; And a kinematic variable estimator configured to estimate kinematic parameters of the robot based on static kinematic modeling result information using the kinematic modeling equation for the measured value information and the robot acquired by the measured value information acquisition unit. The estimator is provided with a robot kinematic variable estimation system for estimating kinematic parameters of the robot by applying a Kalman filter in consideration of the measured value information and noise components included in the modeling of the robot.

The static kinematic equation of the controlled robot can be constructed based on the POE on the joint rotation angle of the controlled robot.

In the kinematic parameter estimation process using the Kalman filter, a matrix representing system dynamics may be assumed to be a unit matrix that does not change with time.

Other aspects, features, and advantages other than those described above will become apparent from the following drawings, claims, and detailed description of the invention.

According to a preferred embodiment of the present invention, it is possible to provide a method for estimating a robot kinematics variable that considers both the noise of the measurement system and the uncertainty of the kinematic model in the robot control system.

Hereinafter, embodiments of the robot kinematic variable estimation method according to the present invention will be described in detail with reference to the accompanying drawings. However, this is not intended to limit the present invention to specific embodiments, it should be understood to include all transformations, equivalents, and substitutes included in the spirit and scope of the present invention. In the following description of the present invention, if it is determined that the detailed description of the related known technology may obscure the gist of the present invention, the detailed description thereof will be omitted. In addition, in the description with reference to the accompanying drawings, the same or corresponding components will be given the same reference numerals and redundant description thereof will be omitted.

1 is a diagram illustrating a control environment in which a method for estimating robot kinematics variables is used according to an embodiment of the present invention.

The robot 100 to be controlled is a robot including a plurality of joints, and includes a measuring system 102 including a sensor for measuring information about the attitude of the robot and a driving system 104 including an actuator such as a motor. It may include. The measurement system 102 may measure a joint rotation angle, a link to an arm displacement, and the like of the robot 100 to be controlled by using a sensor including a device such as a variable resistance and a strain gauge. Drive system 104 may include components such as motors, cylinders, and the like. The implementation of the measurement system 102 and the drive system 104 is obvious to those of ordinary skill in the art to which the present invention pertains, and thus the detailed description thereof will be omitted.

On the other hand, the control target robot 100 may be a welding automation robot used in the ship building process. An end effector may be attached to one end of the controlled robot. If the robot to be controlled is a welding automation robot used for ship building or the like, the end device will be a welding rod or a welding mechanism.

The controlled robot 100 is controlled by the robot attitude control system 120. The robot attitude control system 120 according to an exemplary embodiment of the present invention may include a measurement value information acquirer 122, a kinematic variable estimator 124, and a control signal generator 126.

The measurement value information acquisition unit 122 obtains measurement result information of sensors regarding a posture of the robot from the measurement system 102. Signal transmission between the measurement system 102 and the measurement value information acquisition unit 122 may be made through a wired cable or wireless communication. The information obtained by the measured value information obtaining unit 122 may be transferred to the kinematic variable estimating unit 124 and used as basic data for estimating the kinematic variable of the robot to be controlled. The kinematic variable estimator 124 according to an embodiment of the present invention is characterized by using a Kalman filter, and unlike the general Kalman filter, the estimation performance improved by considering sensing noise and system modeling noise in the measurement system 102. It is characterized by showing. In addition, the kinematic parameter estimator according to an embodiment of the present invention assumes a system dynamics matrix as a unit matrix in the process of calculating the state vector of the Kalman filter discretized in the time domain in relation to the application of the Kalman filter. Can be differentiated. A detailed process of the kinematic parameter estimation method using the Kalman filter will be described in detail with reference to FIGS. 2 to 4.

The control signal generator 126 may generate a control signal to be transmitted to the driving system 104 to control the attitude of the controlled robot 100 as desired based on the estimated kinematic variable. The generated control signal may be reflected to a motor and / or a hydraulic cylinder that is a component of the driving system 104 to change the attitude of the robot 100 to be controlled.

2 is a flowchart of a method for estimating robot kinematics parameters according to an embodiment of the present invention. 3 is a diagram illustrating a robot kinematics parameter estimation process according to an embodiment of the present invention. 4 is a diagram illustrating a zero posture of a control target robot according to an exemplary embodiment of the present invention.

Referring to FIG. 2, in the method of estimating robot kinematic variables according to an embodiment of the present invention, the method may include obtaining measurement value information from a measurement system (S210), acquiring static kinematic modeling result information (S220), and using a Kalman filter. Estimating a kinematic variable by using a signal (S230), and generating a control signal by using the estimated kinematic variable (S240).

Acquiring measurement value information from the measurement system (S210) is a step of acquiring a sensor signal from the measurement system 102 of the control target robot 100. The type of measurement value information obtained may vary according to the type of sensor installed, and the measurement system 102 may be configured to obtain measurement value information corresponding to a state variable used for robot kinematic variable estimation. Do. The acquired measured value information can be used as basic data for the estimation of kinematic variables together with the calculation result by robot static kinematics modeling.

Obtaining static kinematic modeling result information (S220) is a process of obtaining modeling result information that is a basic data of robot kinematic parameter estimation through modeling of the controlled robot 100. Hereinafter, the static kinematic modeling of the control target robot to which the robot kinematic variable estimation technique is applied according to an embodiment of the present invention will be described in detail.

Referring to FIG. 4, the control target robot 100 includes six joints. As illustrated in FIG. 4, the zero posture of the robot to be controlled may be set to a state where each arm (link) of each robot joint is orthogonal to each other. The variables that must be controlled in order for the controlled robot to perform the desired task are the pose (position and angle) of the end-effector.

In one embodiment of the present invention, the pose of the end device can be calculated based on the angle of each joint. The following equation is the attitude (position and orientation) of the end device expressed on a product-of-exponentials (POE) basis, based on the zero posture illustrated in FIG.

는 말단 장치의 자세(위치 및 방향),

는 호모지니어스 좌표계(homogeneous coordinate)에서의 정기구학식(forward kinematics),

는 각 조인트의 각도,

는 기구학 파라미터(kinematic parameter),

은 영점 자세 호모지니어스 매트릭스(zero-configuration homogenous matrix)를 의미한다.

Is the posture (position and orientation) of the end device,

Is the forward kinematics in homogeneous coordinates,

Is the angle of each joint,

Kinematic parameter,

Denotes a zero-position homogenous matrix.

In the kinematic equation expressed on the basis of POE as expressed in Equation 1, all kinematic parameters such as the length of each link may be expressed by the rotation angle of each rotation axis (joint) and the displacement between each rotation axis. In addition, each joint offset may also be modeled and included in the modeling.

In the case of the control target robot 100 illustrated in FIG. 4, if the DH parameter is generally used, the attitude of the robot may be represented by only four parameters. In the modeling according to an embodiment of the present invention, six pieces of information, POE-based modeling using rotation angle information at each joint can be applied. The application of POE-based modeling has the advantage that the inverse kinematics can solve the solution more efficiently without applying excessive frames.

In addition, in the robot kinematic variable estimation method according to an embodiment of the present invention, a linearized kinematic variable error equation may be applied as follows.

The error equation linearized in Equation 2 is obtained from Equation 3, which means the speed of the end device in the spatial coordinate system.

는 측정된(measured 또는 real)

및 명목(nominal)

을 사용하여 다음 수학식과 같이 근사적으로 표현될 수 있다. In the above equation

Is measured (measured or real)

And nominal

It can be approximated using the following equation.

As shown in the above equation, a linearized kinematic variable error equation consisting only of an offset of each joint of the controlled robot 100 may be derived. This feature is clearly distinguished in that the general Kalman filter and the system dynamics matrix are assumed to be an identity matrix. That is, since the kinematic parameters will be kept constant over time, the matrix representing the system dynamics can be assumed as the unit matrix. This assumption improves the performance of the proposed Kalman filter, which improves the kinematic parameter estimation performance of the robot. You can achieve the result.

Meanwhile, the detailed description of the adjoint transformation and the adjoint matrix A applied in Equation 5 is obvious to those skilled in the art to which the present invention pertains, and a detailed description thereof will be omitted below. .

Estimating the kinematic variable using the Kalman filter (S230) is based on the measured value information and robot static kinematic modeling result obtained by the measurement value information obtaining unit 122 from the measurement system 102, and applies the Kalman filter By estimating the robot kinematics variables. The application of the Kalman filter to the temporally discretized system can be expressed by the following equation.

는 상태 벡터,

는 시스템 입력,

및

는 시스템 다이나믹스(system dynamics)를 의미한다.

는 측정 값,

및

는 각각 측정 시스템 및 기구학 모델링에서의 노이즈 성분을 의미한다.

State vector,

Input system,

And

Means system dynamics.

Is the measured value,

And

Denote noise components in the measurement system and kinematic modeling, respectively.

During the application of the Kalman filter, the state vector representing the attitude of the robot 100 to be controlled may be estimated by repeatedly performing two update steps. These two update phases are a time update phase and a measurement update phase, respectively. The process of robot kinematic parameter estimation using the Kalman filter according to an embodiment of the present invention can be expressed by the following equation.

,측정 노이즈 크기

및 초기 조건들에 대하여 추정 오차들을 최소화하는 방향으로 결정된다. 칼만 필터의 적용에 관한 두 업데이트 단계 중 측정 업데이트 단계는 다음의 수학식들에 의하여 표현될 수 있다. Each covariance matrix and gain values can change over time, given the modeling noise magnitude

Measuring noise magnitude

And for minimizing estimation errors with respect to initial conditions. The measurement update step of the two update steps related to the application of the Kalman filter may be represented by the following equations.

The time update step for applying the Kalman filter can be expressed by the following equation.

는 일종의 시스템 디스터번스를 고려하기 위해 앞서 언급된 업데이트 단계들에서 고려된다. 이와 같이 시스템 디스터번스를 고려함으로써 업데이트 과정에서 상태 벡터가 실제 값으로 수렴하지 못하는 현상을 예방할 수 있다. 이상에서 언급된 칼만 필터링을 적용한 모의 실험 결과는 도 6A 내지 도 6F, 그리고 도 7을 참조하여 상세히 설명될 것이다. Assuming no perfect modeling exists,

Is considered in the update steps mentioned above to take into account a kind of system disturbance. By considering the system disturbance as described above, it is possible to prevent the state vector from converging to the actual value during the update process. Simulation results applying the Kalman filtering mentioned above will be described in detail with reference to FIGS. 6A to 6F and FIG. 7.

Generating a control signal using the kinematic variable (S240) is a step of generating a control signal for correcting the attitude of the control target robot 100 based on the kinematic variable estimated by the kinematic variable estimator. As a result of the estimation of the kinematic variables, when the attitude of the control target robot 100 has a desired posture and an error, the control signal generator 126 generates a control signal for correcting the error to drive the system of the control target robot 100. Forward to 104.

5 is a diagram illustrating a simulation result of a conventional robot kinematic variable estimation method. Referring to FIG. 4, it can be observed that the convergence of the joint rotation angle estimation result, which is a robot kinematic variable, changes according to two different noise levels (v = 0.05 or 0.005) for each of the six joint rotation axes.

Kinematic variable estimates with relatively large noise levels (v = 0.05) are shown in red dotted lines, and the convergence performance of kinematic variable estimates with relatively small noise levels (v = 0.005) is indicated by a solid blue line. Are displayed.

Referring to FIG. 5, it can be seen that the convergence speed of the kinematic variable estimation value also decreases when the noise level is relatively large, and the difference between the convergence value and the actual variable value also has a relatively large value. In other words, the larger the noise of the measured value, the greater the influence on the convergence of the estimated kinematic variable.

6A to 6F illustrate simulation results of a kinematic variable estimation algorithm according to an embodiment of the present invention. 7 is a diagram illustrating a noise set applied to the simulation of FIGS. 6A to 6F.

Each factor of Equations 6 to 8 applied to apply the method of applying the Kalman filter described with reference to FIGS. 2 to 4 in the simulation is as follows. Sensor noise and model noise were simulated using the four combinations illustrated in FIG. 7.

6A to 6F, the convergence propensity of kinematic parameter estimation results in four different noise environments is illustrated for each joint of the controlled robot. In the variable estimation process of FIGS. 6A to 6F, the convergence speed may vary according to the noise level. However, as observed in FIG. 5, a phenomenon in which convergence to a different value or fail to converge to a true value is not observed according to the noise level. This shows that the kinematic parameter estimation method according to an embodiment of the present invention is robust to the noise of the measurement system 102 and the uncertainty (noise) of the static kinematic model of the controlled robot 100.

The terminology used herein is for the purpose of describing particular example embodiments only and is not intended to be limiting of the present invention. Singular expressions include plural expressions unless the context clearly indicates otherwise.

In this application, the terms "comprise" or "having" are intended to indicate that there is a feature, number, step, operation, component, part, or combination thereof described in the specification, one or more other It is to be understood that the present invention does not exclude the possibility of the presence or the addition of features, numbers, steps, operations, components, parts, or a combination thereof.

The terms first, second, etc. may be used to describe various components, but the components should not be limited by the terms. The terms are used only for the purpose of distinguishing one component from another.

So far I looked at the center of the present invention with respect to the embodiment. Many embodiments other than the above-described embodiments are within the scope of the claims of the present invention. Those skilled in the art will appreciate that the present invention can be implemented in a modified form without departing from the essential features of the present invention. Therefore, the disclosed embodiments should be considered in descriptive sense only and not for purposes of limitation. The scope of the present invention is shown in the claims rather than the foregoing description, and all differences within the scope will be construed as being included in the present invention.

1 is a diagram illustrating a control environment in which a method for estimating robot kinematics variables is used according to an embodiment of the present invention.

2 is a flowchart of a method for estimating robot kinematics parameters according to an embodiment of the present invention.

3 is a diagram illustrating a robot kinematics parameter estimation process according to an embodiment of the present invention.

4 is a diagram illustrating a zero posture of a control target robot according to an exemplary embodiment of the present invention.

5 is a diagram illustrating a simulation result of a conventional robot kinematic variable estimation method.

6A to 6F illustrate simulation results of a kinematic variable estimation algorithm according to an embodiment of the present invention.

7 is a diagram illustrating a noise set applied to the simulation of FIGS. 6A to 6F.

<Description of the symbols for the main parts of the drawings>

100: control robot 102: measurement system

104: drive system 120: robot attitude control system

124: Kinematic variable estimation unit

Claims (6)

Kinematic variable estimation method for attitude control of robot, Acquiring measurement value information regarding the attitude of the robot from a measurement system; Acquiring static kinematic modeling result information using the static kinematic modeling equation for the robot; And Estimating the kinematic parameters of the robot based on the measured value information and the static kinematic modeling result information and applying a Kalman filter in consideration of the measured value information and noise components included in the modeling of the robot. But The kinematic modeling equation for the robot is a robot kinematic variable estimation method, characterized in that configured based on the POE (product of exponential) for the joint rotation angle of the robot. delete The method of claim 1, Estimate the kinematic variable by applying the Kalman filter, A method of estimating robot kinematics variables, which is performed by assuming a system dynamics matrix as a unit matrix when applying a Kalman filter. A kinematic variable estimation system for robot posture control, A measurement value information acquisition unit for obtaining measurement value information from the measurement system of the robot; A kinematic variable estimator for estimating kinematic parameters of the robot based on static kinematic modeling result information using the kinematic modeling equation for the measured value information and the robot acquired by the measured value information acquisition unit, The kinematic variable estimator estimates the kinematic variable of the robot by applying a Kalman filter in consideration of the measured value information and the noise component included in the modeling of the robot, The kinematic modeling equation for the robot is a robot kinematics variable estimation system, characterized in that configured based on the POE (product of exponential) for the joint rotation angle of the robot. delete 5. The method of claim 4, The kinematic variable estimator A robot kinematic variable estimating system comprising estimating a kinematic variable of the robot by assuming a system dynamics matrix when a Kalman filter is applied as a unit matrix.

Images