APPROACH TO IMPROVEMENT OF ROBOT TRAJECTORY ACCURACY BY DYNAMIC COMPENSATION

Some dynamic factors, such as inertial forces and friction, may affect therobot trajectory accuracy. But these effects are not taken into account in robot motion controlschemes. Dynamic control methods, on the other hand, require the dynamic model of robot and theimplementation of new type controller. A method to improve robot trajectory accuracy by dynamiccompensation in robot motion control system is proposed. The dynamic compensation is applied as anadditional velocity feedforward and a multilayer neural network is employed to realize the robotinverse dynamics. The complicated dynamic parameter identification problem becomes a learningprocess of neural network connecting weights under supervision. The finite Fourier series is used toactivate each actuator of robot joints for obtaining training samples. Robot control system,consisting of an industrial computer and a digital motion controller, is implemented. The system isof open architecture with velocity feedforward function. The proposed method is not model-based andcombines the advantages of close-loop position control and computed torque control. Experimentalresults have shown that the method is validatities to improve the robot trajectory accuracy.

Motion Error Compensation of Multi-legged Walking Robots

Existing errors in the structure and kinematic parameters of multi-legged walking robots,the motion trajectory of robot will diverge from the ideal sports requirements in movement.Since the existing error compensation is usually used for control compensation of manipulator arm,the error compensation of multi-legged robots has seldom been explored.In order to reduce the kinematic error of robots,a motion error compensation method based on the feedforward for multi-legged mobile robots is proposed to improve motion precision of a mobile robot.The locus error of a robot body is measured,when robot moves along a given track.Error of driven joint variables is obtained by error calculation model in terms of the locus error of robot body.Error value is used to compensate driven joint variables and modify control model of robot,which can drive the robots following control model modified.The model of the relation between robot＇s locus errors and kinematic variables errors is set up to achieve the kinematic error compensation.On the basis of the inverse kinematics of a multi-legged walking robot,the relation between error of the motion trajectory and driven joint variables of robots is discussed.Moreover,the equation set is obtained,which expresses relation among error of driven joint variables,structure parameters and error of robot＇s locus.Take MiniQuad as an example,when the robot MiniQuad moves following beeline tread,motion error compensation is studied.The actual locus errors of the robot body are measured before and after compensation in the test.According to the test,variations of the actual coordinate value of the robot centroid in x-direction and z-direction are reduced more than one time.The kinematic errors of robot body are reduced effectively by the use of the motion error compensation method based on the feedforward.

ROBOT'S MOTION ERROR AND ONLINE COMPENSATION BASED ON FORCE SENSOR

Robot＇s dynamic motion error and on-line compensation based on multi-axis force sensor are dealt with.It is revealed that the reasons of the error are formed and the relations of the error are delivered.A motion equation of robot＇s termination with the error is established,and then,an error matrix and an error compensation matrix of the motion equation are also defined.An on-line error＇s compensation method is put forward to decrease the displacement error,which is a degree of millimeter,shown by the result of simulation of PUMA562 robot.

Accuracy Compensation Technology of Closed⁃Loop Feedback of Industrial Robot Joints

The existing kinematic parameter calibration method cannot further improve the absolute positioning accuracy of the robot due to the uncertainty of positioning error caused by robot joint backlash.In view of this problem,a closed‑loop feedback accuracy compensation method for robot joints was proposed.Firstly,a Chebyshev polynomial error estimation model was established which took geometric error and non‑geometric error into account.In addition,the absolute linear grating scale was installed at each joint of the robot and the positioning error of the robot end was mapped to the joint angle.And the joint angle corrected value was obtained.Furthermore,the closed‑loop feedback of robot joints was established to realize the online correction of the positioning error.Finally,an experiment on the KUKA KR210 industrial robot was conducted to demonstrate the effectiveness of the method.The result shows that the maximum absolute positioning error of the robot is reduced by 75%from 0.76 mm to 0.19 mm.This method can compensate the robot joint backlash effectively and further improve the absolute positioning accuracy of the robot.

Force Compensation Control for Electro-Hydraulic Servo System with Pump-Valve Compound Drive via QFT-DTOC

Each joint of a hydraulic-driven legged robot adopts a highly integrated hydraulic drive unit(HDU),which features a high power-weight ratio.However,most HDUs are throttling-valve-controlled cylinder systems,which exhibit high energy losses.By contrast,pump control systems offer a high efficiency.Nevertheless,their response ability is unsatisfactory.To fully utilize the advantages of pump and valve control systems,in this study,a new type of pump-valve compound drive system(PCDS)is designed,which can not only effectively reduce the energy loss,but can also ensure the response speed and response accuracy of the HDUs in robot joints to satisfy the performance requirements of robots.Herein,considering the force control requirements of energy conservation,high precision,and fast response of the robot joint HDU,a nonlinear mathematical model of the PCDS force control system is first introduced.In addition,pressure-flow nonlinearity,friction nonlinearity,load complexity and variability,and other factors affecting the system are considered,and a novel force control method based on quantitative feedback theory(QFT)and a disturbance torque observer(DTO)is designed,which is denoted as QFT-DTOC herein.This method improves the control accuracy and robustness of the force control system,reduces the effect of the disturbance torque on the control performance of the servo motor,and improves the overall force control performance of the system.Finally,experimental verification is performed using the PCDS performance test platform.The experimental results and quantitative data show that the QFT-DTOC proposed herein can significantly improve the force control performance of the PCDS.The relevant force control method can be used as a bottom-control method for the hydraulic servo system to provide a foundation for implementing the top-level trajectory planning of the robot.

An effective algorithm for needle tip displacement compensation in robot-assisted percutaneous surgery

This paper presents an automatic compensation algorithm for needle tip displacement in order to keep the needle tip always fixed at the skin entry point in the process of needle orientation in robot-assisted percutaneous surgery. The algorithm, based on a two-degree-of-freedom （2-DOF） robot wrist （not the mechanically constrained remote center of motion （RCM） mechanism） and a 3-DOF robot ann, firstly calculates the needle tip displacement caused by rotational motion of robot wrist in the arm coordinate frame using the robotic forward kinematics, and then inversely compensates for the needle tip displace- ment by real-time Cartesian motion of robot arm. The algorithm achieves the function of the RCM and eliminates many mechanical and virtual constraints caused by the RCM mechanism. Experimental result demonstrates that the needle tip displacement is within 1 inm in the process of needle orientation.

Attitude Stabilization of a Novel Flying Robot by Dynamic Compensation

This paper gives details about the controller design that aims to stabilize the novel twinrotor flying robot, Toruk. Toruk is an experimental test bench to study center of gravity steering, effect of the location of the center of gravity, controller design and implementation, etc. Physical components are also briefly discussed in this paper. Attitude dynamics of the system is inherently unstable. It is stabilized by a regulator. In addition, an observer is designed and utilized to estimate the unmeasured states. Thrust force generated by the propulsion unit is estimated by using the identified mathematical model of the unit. An experimental setup is employed to identify the mathematical model that expresses the relation between the applied input voltage to the propulsion unit and thrust produced by the propeller. Mathematical model for the attitude dynamics of Toruk is built. Then controllability and observability analysis are carried out for the system. Dynamic compensator composed of a state observer and a regulator, is designed on the mathematical model. Physical implementation on the system will be performed.

Force Control Compensation Method with Variable Load Stiffness and Damping of the Hydraulic Drive Unit Force Control System

Each joint of hydraulic drive quadruped robot is driven by the hydraulic drive unit（HDU）, and the contacting between the robot foot end and the ground is complex and variable, which increases the difficulty of force control inevitably. In the recent years, although many scholars researched some control methods such as disturbance rejection control, parameter self-adaptive control, impedance control and so on, to improve the force control performance of HDU, the robustness of the force control still needs improving. Therefore, how to simulate the complex and variable load characteristics of the environment structure and how to ensure HDU having excellent force control performance with the complex and variable load characteristics are key issues to be solved in this paper. The force control system mathematic model of HDU is established by the mechanism modeling method, and the theoretical models of a novel force control compensation method and a load characteristics simulation method under different environment structures are derived, considering the dynamic characteristics of the load stiffness and the load damping under different environment structures. Then, simulation effects of the variable load stiffness and load damping under the step and sinusoidal load force are analyzed experimentally on the HDU force control performance test platform, which provides the foundation for the force control compensation experiment research. In addition, the optimized PID control parameters are designed to make the HDU have better force control performance with suitable load stiffness and load damping, under which the force control compensation method is introduced, and the robustness of the force control system with several constant load characteristics and the variable load characteristics respectively are comparatively analyzed by experiment. The research results indicate that if the load characteristics are known, the force control compensation method presented in this paper has positive compensation effects on the load characteristics variation, i.e., this method decreases the effects of the load characteristics variation on the force control performance and enhances the force control system robustness with the constant PID parameters, thereby, the online PID parameters tuning control method which is complex needs not be adopted. All the above research provides theoretical and experimental foundation for the force control method of the quadruped robot joints with high robustness.

Study on path planning and compensation of off-line programming for thick walled curve welding

Thick walled curve welding are usually joined by multi-layer and multi-pass welding, which quality and efficiency could be improved by off-line programming of robot welding. However, the precision of off-line programming welding path was decreased due to the deviation between the off-line planned welding path and the actual welding path. A path planning algorithm and a path compensation algorithm of multi-layer and multi-pass curve welding seam for off-line programming of robot welding are developed in this paper. Experimental results show that the robot off-line programming improves the welding efftcieney and precision for thick walled curve welding seam.

面向肺部介入的光纤光栅三维力传感器设计

支气管曲折复杂的环境对肺部介入手术中柔性机器人末端力感知造成了较大的困难,现有的力传感器难以满足其要求。根据肺部介入手术的需求,为柔性机器人提供精确、实时的末端力反馈,设计了分段式光纤光栅三维力传感器,并对其结构进行了有限元仿真分析与优化,设计了解耦算法,完成传感器内部4根光栅受到三维力时波长变化的解耦,从而实现对横向力与轴向力的检测。设置温补光栅进行温度补偿,设计了补偿策略,降低了温度变化对传感精度的影响。最后,对所设计的光纤光栅力传感器进行了校准与实验验证。实验结果表明:设计的光纤光栅三维力传感器的横向力灵敏度系数分别为431.3 pm/N与517.6 pm/N,轴向力灵敏度系数为153.5 pm/N,均方根误差分别为0.026、0.025、0.041 N。

A calibration and compensation method for an industrial robot with high accuracy harmonic reducers

Industrial serial robots need high stiffness to keep absolute pose accuracy and meet the requirements in practical applications. However, the weak stiffness feature of robot joints and the payloads affected on robot end-effector, which will also increase the pose error of robot. Especially, the existing calibration methods often consider under no-payload condition without discussing the payload state. In this paper, we report a new industrial serial robot composed by a new harmonic reducer: Model-Y, based on high accuracy and high stiffness, and a kinematic parameter calibration algorithm which is based on a harmonic reducer forcedeformation model. To decrease the accuracy effects of payload, an iterative calibration method for kinematic parameters with payload situation was proposed. Simulation and experiments are conducted to verify the effectiveness of the proposed calibration method using the self-developed industrial serial robot. The results show a remarkably improved accuracy in absolute position and orientation with the robot's payload range. The position mean error has 70% decreased to 0.1 mm and the orientation mean error diminished to less than 0.01° after calibration with compensation. Additionally, online linear and circular tests are carried out to evaluate the position error of the robot during large-scale spatial and low-speed continuous movement. The accuracy is consistent with the previous calibration results, indicating the effectiveness and advantages of the proposed strategy in this article.

Research and Realization of a Master-Slave Robotic System for Retinal Vascular Bypass Surgery

Retinal surgery continues to be one of the most technical demanding surgeries for its high manipulation accuracy requirement, small and constrained workspace, and delicate retinal tissue. Robotic systems have the potential to enhance and expand the capabilities of surgeons during retinal surgery. Thus, focusing on retinal vessel bypass surgery, a master-slave robot system is developed in this paper. This robotic system is designed based on characteristics of retinal vascular bypass surgery and analysis of the surgical workspace in eyeball. A novel end-effector of two degrees of freedom is designed and a novel remote center of motion mechanism is adopted in the robot structure.The kinematics and the mapping relationship are then established, the gravity compensation control strategy and the hand tremor elimination algorithm are applied to achieve the high motion accuracy. The experiments on an artificial eyeball and an in vitro porcine eye are conducted, verifying the feasibility of this system.

Fault-Tolerant Control of a CPG-Governed Robotic Fish

Fault tolerance is essential for the maneuverability of self-propelled biomimetic robotic fish in real-world aquatic applications.This paper explores the fault-tolerance control problem of a free-swimming robotic fish with multiple moving joints and a stuck tail joint.The created control system is composed of two main components:a feedback controller and a feedforward compensator.Specifically,the bio-inspired central pattern generator-based feedback controller is designed to make the robotic fish robust to external disturbances,while the feedforward compensator speeds up the convergence of the overall control system.Simulations are performed for control system analysis and performance validation of the faulty robotic fish.The experimental results demonstrate that the proposed fault-tolerant control method is able to effectively regulate the faulty robotic fish,allowing it to complete the desired motion in the presence of damage and thereby improving both the stability and the lifetime of the real robotic system.

Position Errors and Interference Prediction-Based Trajectory Tracking for Snake Robots

This work presents a trajectory tracking control method for snake robots.This method eliminates the influence of time-varying interferences on the body and reduces the offset error of a robot with a predetermined trajectory.The optimized line-of-sight(LOS)guidance strategy drives the robot’s steering angle to maintain its anti-sideslip ability by predicting position errors and interferences.Then,the predictions of system parameters and viscous friction coefficients can compensate for the joint torque control input.The compensation is adopted to enhance the compatibility of a robot within ever-changing environments.Simulation and experimental outcomes show that our work can decrease the fluctuation peak of the tracking errors,reduce adjustment time,and improve accuracy.

Developing of robot flexible processing system for shipbuilding profile steel

A robot flexible processing system of shipbuilding profile steel was developed. The system consists of computer integrated control and robot. An off line programming robot was used for marking and cutting of shipbuilding profile steel. In the system the deformation and position error of profile steel can be detected by precise sensors, and figure position coordinate error resulted from profile steel deformation can be compensated by modifying traveling track of robotic arm online. The practical operation results show that the system performance can meet the needs of profile steel processing.

The Offline Program Profile Lining and Cutting Robot System

The paper introduces a new type of cutting system: the Offline Program Profile Lining and Cutting Robot System (OPPLCRS). The system adopts the offline program technology without teaching. The system can measure and compensate every profile’s deformation automatically, so it is suit to process any batch of profiles, and the order of processing different profiles can be arranged at will. The OPPLCRS, firstly appearing in China, will have wide application in profile cutting fields.

Robot Calibration Using Active Vision-based Measurement

This paper presents an efficient robot calibration method with non-contact vision metrology. Using the coplanar pattern to calibrate camera made the active-vision-based end-effector pose measurement be a feasible and costeffective way. Kinematic parameter errors were linearized and identified through two-step procedure, thus the singular and non-linear condition was overcome. These errors were then compensated using inverse model method. The whole calibration process is flexible, easy to implement and prevents the error propagation from the earlier stages to the later ones. Calibration was performed on MOTOMAN SV3industrial robot. Experiment results show that the proposed method is easy to setup and with satisfactory accuracy.

狭长空间内重载调姿装配机器人的设计与研究

针对舱体类狭长空间内部待安装设备种类多、批量大、载荷重、空间余量微小、装配路径复杂、装配风险高等问题,设计了一种重载调姿装配机器人。在机器人运动学研究的基础上,建立了误差模型,并以最小包围球半径为约束条件,通过遗传算法将误差参数的辨识结果补偿到机器人控制系统。以机柜装配为例,针对空间约束条件规划工作路径,基于动力学约束能耗函数模型,以时间、冲击和能耗为优化目标,得到多目标最优轨迹。样机实验验证了误差参数辨识的有效性,减小了机器人的绝对定位误差,且多目标最优轨迹的关节总冲击小、运动平稳,实现了机柜类设备高效、平稳、可靠的安装。

Dynamic Analysis of Three-link Robot

As modem society is developing rapidly, the robots in our lives as well as industrial manufacturing and other aspects have occupied an important position. Requirements for the robot control and accuracy are getting higher and higher, and the dynamic control of the robot has thus been getting the better development. The dynamic problem of the robot is helpful to keep the dynamic characteristics and static characteristics of the robot, which is of great significance to the control problem of the robot. In the process of dynamic analysis of the three-link robot, the system model of the three-link robot is simplified accordingly, and then the classical Lagrangian functional equilibrium method is used to derive the robot dynamics equation. After the kinetic equation, based on the passive characteristics of the three-link robot arm, we use the PD control with gravity compensation for the robot, and use the Lyapunov function to prove that the system has any trajectories in the vicinity of the equilibrium state under any initial condition which is near the equilibrium state, proves the stability of the three-link robot system.

机器人几何参数误差识别与补偿方法及实验

工业机器人因其组织灵活性、强可拓展性,在叶片类复杂零件的高精度加工中得到越来越多的关注,这对机器人末端执行机构的定位精度提出了更高的要求。文章基于自主设计研发的六自由度关节机器人进行几何参数误差识别和补偿方法研究,旨在提高机器人末端执行机构的定位精度。首先,基于D-H法建立机器人各关节转角与末端位置坐标的关系模型,建立分别考虑连杆长度误差、连杆偏置误差和关节转角误差的位置误差模型;然后,基于自主设计的专用测头进行运动过程坐标数据测量实验,基于实验数据采用Levenberg-Marquardt进行几何参数误差项识别;最后,将识别的结果在机器人模型中进行补偿,并对补偿后的效果进行实验验证,结果表明,补偿后的定位精度比补偿前提高了60%以上。