.
本科毕业设计(论文) 外文翻译（附外文原文）
学 院：机械与控制工程学院
课题名称：搬运机械手的结构和液压系统设计
专业(方向)： 机械设计制造及其自动化（机械装备） 班 级： 学 生： 指导教师：
日 期： 2015年3月10日
.
桂林理工大学本科毕业设计·外文翻译
Proceedings of the 33rd Chinese Control Conference July 28-30, 2014, Nanjing, China
The Remote Control System of the Manipulator
SUN Hua, ZHANG Yan, XUE Jingjing , WU Zongkai
College of Automation, Harbin Engineering University, Harbin 15000
E-mail: sunhuas@hrbeu.edu.cn
Abstract: A remote control system of the 5 degree of freedom manipulator was designed.
This manipulator was installed into our mobile robot to constitute a remote rescue robot. TheDenavit-Hartenberg method was used to establish the kinematic models and the path planning of the manipulator was researched. The operator could remote control the manipulator by the interactive interface of PC which could display moving picture and various data of the manipulator. The servos of the manipulator were controlled by the slave FPGA controller. In addition, the slave FPGA controller communicated with the PC via the wireless communication module. Owing to the embedded Nios II program and IP (Intellectual Property) core generating PWM waves inFPGA, the system could control the multiple servos fast and flexible. In order to achieve real-time operation and simulation, the interactive interface was established by the mixed programming of VC and MATLAB.
Key Words: The manipulator; Remote control; Denavit-Hartenberg; FPGA;
Human-computer interaction
1 Introduction
With the development of the microelectronic technique and the computer technology, the manipulator has become essential equipment in the manufacturing industry. As we all known, the manipulator is usually applied to accomplish dull, onerous and repeated physical work, especially used to substitute the manual operation under the dangerous and the hazardous environment such as the corrosion and the high temperature.
In this paper, the manipulator was installed our mobilerobot. The tele-operation system of this manipulator was designed. The whole system is onstituted by PC and slave FPGA. The operator can remote control the manipulator by PC. The wireless communication was used for transmitting data between PC and FPGA. FPGA is controller of the the manipulator in the mobile robot. FPGA has the abundant internal resource and IP cores. And a central control option was built via an embedded Nios II program and an IP core in
1
桂林理工大学本科毕业设计·外文翻译
FPGA.Furthermore, Verilog language was adopted to design the IP core which generated digital PWM waves for controlling the manipulator. Therefore, this system could reach higher precision and easy to debug.
MATLAB software was adopted to build the kinematic models of manipulator. And using D-H (the acronym of Denavit-Hartenberg) method to solve the forward and inverse kinematic equations of the manipulator, to analyze the motivation, to plan and track the motion’s path.
In addition, a good interface of human-computer interaction was enhanced in the remote control system of the manipulator in PC. Moreover, the manipulator simulation technology was built by using the mixed programming of VC and MATLAB. Thus, the motion choreographs was got quickly and easily, also greatly saved time and cut the cost.
2 Manipulator Model and Path Planning
At first, the motion model of the manipulator was built.Then, the kinematic simulation and its path planning were researched. These works provided the foundation for the design of the remote control system of the manipulator.
2.1 Motion Model of the Manipulator
The manipulator was regarded as an open loopkinematic chain. It was constituted by five rotary joints. Andits one end was fixed on a base while the other end was usedto achieve the ability of grabbing. Therefore, it is better toestablish a chain coordinate frame as shown in Fig.1. Theterminal position and attitude was determined via usingforward kinematic equation after knowing the rotating angleof every joint. The D-H parameter table shown as Table 1was established by using the frames in Fig.1.
2
桂林理工大学本科毕业设计·外文翻译
Fig.1 Coordinate frames of mechanical arm Table 1 D-H Parameters of the Robot Arm
Due to D-H method:
????+1??
=????+1
??????+1????????=(??+1??
??????+1??????
0???????+1??????+1????????????+1??????
00?????????????0????
???????????+1
)
??????????+1
1
Where C????+1=cos????+1 , S????+1=sin????+1 , C????=cos???? , S????=sin???? . The transformation matrix of every joint was given by equation (2).
cos??1sin??1sin??1cos??10
1??=(00
00cos??3?sin??3sin??3cos??32
3??=(00
00
cos??5sin??54
5??=(0
0
?sin??5cos??500
??
??
0010cos??2?sin??20
0)1??=(002
?sin??2?cos??20
100
00
1??1
) 000100?1???3
)
0001
00cos??4?sin??400)3??=(00
4
sin??4cos??41??2
0001
????
????????0
????????????0
????00
00)0??=(????
????1??45
001
??
????
????0?1?2?3?4
)=1??2??3??4??5?? (2) ????1
??
??
Where unit vector→,→,→ in equation (2) was →=????????????, →=??????????????????????, →=???????????????, →=????????????????. Parameters of mechanical arm were given by ??1=
??
??
85mm,??2=116mm,??3=85mm ,??4=95mm. Therefore the forward kinematic equation was determined by taking every parameter in equation (3). 180????1??(??2+??3)+116????1????2
0
5??=(180????1??(??2+??3)+116????1????2) (3)
85+116????2+180??(??2+??3)
3
桂林理工大学本科毕业设计·外文翻译
In practical application, the manipulator was adopted to grab objects. This required that the fixed position was given from terminal to target location. That was the inverse kinematic analysis of manipulator. Inverse transformation was used to determine angle of every rotary joint toward theestablished coordinates. And the used method of inverse transformation was the common method to solve such problem (this method also known as
?1
algebraic method).Using inverse transformation???1???? separately to the left multiplication 0?1?2?3?4with 05??=1??2??3??4??5?? , the angle of every rotary joint（??1 ??2 ??3 ??4 ??5）was
determined. Owing to these results, the rotary angles（??1??2??3）at terminal position of manipulator were totally decided by the target position[???? ???? ????]. Angle ??4was used to change terminal attitude of the manipulator and it was changed by the known normal vector. However, angle ??5, was decided by the size of target object.
2.2 Motion Simulation of the Manipulator
The manipulator model was built and simulated via MATLAB toolbox. We could verify the rationality of the mathematical model. While the MATLAB model was established by table 1 and shown as Fig.2
Fig.2 MATLAB simulation of the manipulator
Comparing to the Fig.1 and Fig.2, the simulation model of the manipulator was coincided to the reference frame model. That was to say, the given coordinate frame was correct. These results also could be proved by the determined inverse kinematic equations via MATLAB shown in the table (2) and table (3).
The target position was solved by forward kinematics.After that, the rotary angles were calculated by inverse kinematical equation. It turned out that these rotary angles coincided
4
机械手外文翻译
