CN101791801B - Industrial robot motion planning and performance testing system and implementation method thereof - Google Patents

Industrial robot motion planning and performance testing system and implementation method thereof Download PDF

Info

Publication number
CN101791801B
CN101791801B CN2010100194507A CN201010019450A CN101791801B CN 101791801 B CN101791801 B CN 101791801B CN 2010100194507 A CN2010100194507 A CN 2010100194507A CN 201010019450 A CN201010019450 A CN 201010019450A CN 101791801 B CN101791801 B CN 101791801B
Authority
CN
China
Prior art keywords
robot
module
spraying
joint
data
Prior art date
Application number
CN2010100194507A
Other languages
Chinese (zh)
Other versions
CN101791801A (en
Inventor
刘治
陈圣国
梁少芳
周英
Original Assignee
广东工业大学
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 广东工业大学 filed Critical 广东工业大学
Priority to CN2010100194507A priority Critical patent/CN101791801B/en
Publication of CN101791801A publication Critical patent/CN101791801A/en
Application granted granted Critical
Publication of CN101791801B publication Critical patent/CN101791801B/en

Links

Abstract

The invention relates to an industrial robot motion planning and performance testing system and an implementation method thereof. The system comprises a database module, a man-machine interaction module, a spray gun track planning module, an analysis and display module, a robot job instruction generation module and a communication and interface module, wherein the database module realizes storage of the spray gun track and the joint variable of the spraying robot as well as the spraying tasks; the man-machine interaction module realizes parameter input and control on other modules; the spray gun track planning module is used for planning a spray gun track for optimizing the spraying effect and working out the joint variable corresponding to the track on the premise of meeting all the limits; the analysis and display module simulates and analyzes the spraying process of the spraying robot; the robot job instruction generation module realizes the function of generating spraying robot job files; and the communication and interface module is used for importing spraying task data, and uploading and downloading job files. The invention has the advantages of high programming speed, high accuracy, complete functions and strong versatility, and can be used for scientific research in various types of robots and control on the actual spraying operating system.

Description

Industrial robot motion planning and Performance Test System and its implementation

Technical field

The present invention is a kind of industrial robot motion planning and Performance Test System and its implementation; Particularly a kind of spray robot motion planning and Performance Test System and its implementation belong to the innovative technology of industrial robot motion planning and Performance Test System and its implementation.

Background technology

In recent years, spray robot is because the spraying cycle is short, and precision is high, and is profitable, and characteristics such as can under rugged environment, work long hours are applied in increasing spraying occasion.But up to the present, go back comprehensive spray robot motion planning of neither one and Performance Test System and occur, traditional motion planning and Performance Test System generally adopt teach programming, and be not only loaded down with trivial details, toward contact the teaching of sample ability need be arranged earlier.Existing industrial robot motion planning and Performance Test System general utility functions are single, do not possess the performance evaluation system of synthesization, especially in the spray robot application, lack special system platform especially.Therefore, develop a kind ofly, make that the optimum spray robot off-line programing system of spraying effect is extremely urgent based on computer graphics.

Along with the development of computer graphics, the model of setting up actual object and surrounding environment becomes very convenient.The object of spraying operation generally is the scope of freedom; Utilize computer graphics that the moulding on this surface is had several different methods: Bezier method, Coon/Ferguson method, B batten method; NUB (uniform B-Spline) method, NURB (non-uniform rational B-spline) method and the combination in any between them.These methods respectively have the advantage of oneself, and the Bezier method is to be the basis to approach, and utilize control polygon or control multiaspect shape to generate curve or curved surface, make that the design of curve and curved surface is easier.Coons (Kong Si) curved surface adopts the sectional curve amalgamation to come the complex structure curve, and employing can be that four edges circle of any type parameter curve comes constructing curve, and the method woods proposes to confirm this patch border of bicubic mix aperture method of tangent vector transboundary.B batten method is local propagated and controllable shapes property outstanding because of it, so use extensive.The method of acquisition actual object model has multiple, except through the direct moulding of computer graphics, can also read the data of other CAD systems through interface, perhaps obtains model data through scanning material object.

No matter trajectory planning is in theory research, still aspect practical applications, all more and more ripe.Geometrical model with the spraying object is the basis; Set up film thickness growth model and the cost functional of estimating spraying effect in the spraying process; Under the prerequisite that satisfies the constraint of robot kinematics and dynamics; Ask for the extreme value of cost functional, plan send as an envoy to spraying effect best spray gun path, direction and speed.Existing interpolation method has multiple, like linear interpolation, and Lagrange's interpolation, piecewise interpolation, three rank B spline interpolations etc., and ripe algorithm is all arranged, this carries out interpolation for joint variable provides convenience.

In big system, owing to will call and generate lot of data, how these data are effectively managed and stored, become distinct issues.The generation of database is for addressing this problem a kind of good method that provides, through system is set up special-purpose database; Not only conveniently read and store data; Improve the operational efficiency of system, and made things convenient for the management and the transplanting of system data, the versatility of enhanced system.The DB2 that IBM is arranged that existing Database Systems are many and ripe, wherein commonly used, Oracle, Informix, Sybase, SQL Server and Access etc.

(application number: proposed a kind of processing program generating device 200510088687.X), have offline programming device, the main composition such as vision sensor, robot controller and communicator etc. to the Chinese invention patent of Japan Fa Na Co., Ltd. application.It in offline programming device the summit of formulating the workpiece shape; The crest line end points generates machining path as taught point, thereby generates procedure; And the position and attitude of the practical work piece that obtains through vision sensor revises program, and this method does not break away from teach programming in essence.The industrial robot off-line programing system of Shanghai Communications University's application (application number: 200710043744.1) mainly contain text editing and code conversion module, graphical verification module, communication and remote control module.The function that is realized mainly is the conversion of the INFORMI I code operation program used to the MOTOMAN robot by the G code numerical control program, generates MOTAMAN robot working document, and carries out emulation and verification with 3-D graphic.This methodological function is single, and versatility is not strong, can only be applied to the robot of model, and lacks the Performance Evaluation and the analytical system of synthesization.

Summary of the invention

The objective of the invention is to consider the problems referred to above and provide a kind of degree of accuracy high, industrial robot motion planning that production efficiency is high and Performance Test System.

Another object of the present invention is to provide a kind of convenient and practical industrial robot motion planning and the implementation method of Performance Test System.

Technical scheme of the present invention is: industrial robot motion planning of the present invention and Performance Test System; Industrial robot motion planning and Performance Test System; It is characterized in that including the storage and management that is used for implementation model data and information DBM, running with the input of required various parameters with to the human-computer interaction module of the control of other module, automatically generate the spray gun trajectory planning module that makes the best spray gun track of spraying effect, graphically show the coating situation of spray gun surface of the work when path planning sprays; And the analysis of average thickness and deviation data thereof that provides paint film on the surface of the work with tabular form with display module, be used to realize the generation of robot work order robot manipulating task instruction generation module, realize the communicating by letter and interface module of information transmission between inside and the outside; After the user sends the control instruction that imports robot or spraying task data through human-computer interaction module to communication and interface module, communication and interface module according to the instruction type of human-computer interaction module with the robot model of outside or spray task data and deposit in the corresponding subdata base in the DBM; Control information and parameters such as relative position, spray gun angular aperture such as the method for planning track that transmits according to human-computer interaction module, interpolation method, the robot model and spraying task data that transmit according to DBM accomplish trajectory planning again; When human-computer interaction module to analyzing when sending the control instruction that begins to spray with display module; Analyze with display module and can the joint variable that obtain in the spray gun trajectory planning module be called in; From DBM, read in robot model and spraying task data simultaneously; From human-computer interaction module, obtain corresponding spray parameters, carry out the demonstration of spraying process; After obtaining satisfied spraying effect, human-computer interaction module will send the control instruction of storage joint variable to DBM, and the joint variable that best spraying effect is corresponding deposits in the DBM; Human-computer interaction module is after human-computer interaction module sends the order that generates the robot manipulating task instruction to robot manipulating task instruction generation module; Robot manipulating task instruction generation module is transferred the joint variable in the DBM; The generation that fulfils assignment and instruct; If added new robot model, the transcode of importing through human-computer interaction module will join in the robot manipulating task instruction generation module automatically; When human-computer interaction module sends when downloading code command to communication and interface module, the robot manipulating task instruction that robot manipulating task instruction generation module generates will be delivered in the robot controller through communication and interface module and communication cable.

Above-mentioned DBM comprises spraying task data library module; The spray robot model module, spraying profile DBM, joint trajectories DBM; The joint moment DBM; Spraying task data library module is used to deposit the cad data through object after the moulding, or the data of other CAD systems that read through interface, also can be through scanning the model data that material object obtains; The spray robot model module is used to store robot model's data that the user imports through interface; The spraying profile database module stores be to satisfy the best spraying profile of spraying effect under the prerequisite of constraints, the joint trajectories DBM is deposited the different rotational angles constantly in each joint of robot that obtain through kinematics solution, angular speed passes through the joint trajectories that is generated after the different interpolation processing with angular acceleration or characteristic point; Joint velocity and angular speed, joint moment DBM are realized the different storages of joint moment constantly in each joint of robot.

Above-mentioned DBM comprises the Administration menu of database, and Administration menu is realized the effective management to different objects in the database, comprises interpolation, and memory function is revised in deletion.

Above-mentioned human-computer interaction module comprises that spray parameters is provided with module, control module and program editing module.Through spray parameters module is set, the user can be provided with robot parameter, spray parameters; The method of trajectory planning and interpolation, parameters such as the angular aperture of spray gun, environmental variance are in control module; Whether the user can pass through menu, whether controls running job instruction generation module, the instruction code file that generates is sent in the robot controller through communication and interface module; And whether import extraneous spraying task and robot model's data, and can also check the curve of joint variable through clicking menu option, the program editing module is to aim to increase robot manipulating task Programming with Pascal Language rule and the open interface of design; The user imports new robot model through communication and interface module; Can pass through the program editing interface, follow the syntax rule of the corresponding language of this robot model, add the code conversion module.

Above-mentioned spray gun trajectory planning module comprises planning of rectangular co-ordinate space tracking and the planning of joint coordinates space tracking.The foundation of paint thickness growth model and the cost functional of estimating spraying effect in the rectangular co-ordinate space tracking planning realization spraying process; Ask for the extreme value of cost functional through the minimax value-based algorithm; Automatically generation can make the best spray gun track of spraying effect, in addition, can also the spray gun trend of setting in the module be set according to spray gun; The spray gun track is carried out parameter optimization; The spray gun track that is optimized is at last obtained the joint of robot track according to the kinematics method of separating of inverting, and realizes the conversion from the rectangular co-ordinate space to the joint coordinates space.Because some that possibly occur on the optimum spray gun track put the not situation in the robot working space; Therefore must just can obtain satisfied spray gun track through adjustment and emulation repeatedly, the joint coordinates space tracking plans it is on the basis of rectangular co-ordinate space tracking planning, to accomplish, and at first obtains the spray gun track of optimization through the planning of rectangular co-ordinate space tracking; Then; The track characteristic point of constraints is satisfied in taking-up, obtains the corresponding joint variable of characteristic point, adopts different interpolation methods that joint variable is carried out interpolation arithmetic again; Through emulation and analysis, the user can select a kind of interpolation method that relatively is suitable for this spraying task.If dissatisfied to spraying effect, can get the characteristic point that some satisfy constraint more, if increase characteristic point simply still can not obtain satisfied spraying effect, then need revise some characteristic points, till obtaining satisfied spraying effect.

Above-mentioned interpolating module comprises the cubic polynomial interpolation, crosses the cubic polynomial interpolation of path point, and five order polynomials carry out interpolation, with the linear interpolation of parabolic transition, crosses the linear interpolation with parabolic transition of path point, three rank B spline interpolations.

Above-mentioned analysis and display module comprise robot model's demonstration, the demonstration of spraying task, the demonstration of robot motion's situation and spraying effect in the spraying process, the demonstration of the curve of joint variable, the demonstration of spray time.This module by the state of spraying object and robot, shows the Changing Pattern of various variablees according to the data that upper module was provided in the real-time simulation spraying process; And with the tabulation form provide the used energy of spraying process, the average thickness of paint film, deviation and mean square deviation; Whether motion and torque to make things convenient for each joint of customer inspection robot satisfy its constraints; Whether the situation of manipulator collision workpiece takes place, and off-line is observed the terminal accessibility of spray gun, and relatively the method time spent of which kind of trajectory planning is the shortest; Consumed energy is minimum, and which kind of interpolation method is the most reasonable.Be modification spray gun parameter, path, and then the best spraying effect of acquisition provide foundation.

Above-mentioned robot manipulating task instruction generation module comprises the read module of joint data, the generation module of joint pulse, and the choosing and generation module of language conversion module, the read module of joint data is accomplished the task of from the database of joint, reading the joint data; The generation module of joint pulse is realized by the conversion of joint data to the joint pulse value; The language conversion module choose and generation module is accomplished and the choosing automatically of the robot corresponding language conversion module of model; And realize by the conversion of joint pulse to robot language; Generate the necessary job instruction of robot motion; For obtaining general platform, this module has adopted open programmed method, except the language conversion module of platform provided three kinds of model commonly used robots; The user can pass through modular programming mode, adds and the robot model's corresponding programs conversion module that oneself imports at robot language Transformation Program editing area.At last; This module is selected corresponding with it language conversion module, through calling the joint trajectories that is stored in the joint trajectories database automatically according to the set robot type of user; Accomplish the conversion of joint trajectories to the joint pulse; According to grammar request, generate the job instruction file, and it is kept in the special-purpose project file folder.

Above-mentioned communication and interface module comprise the input of model data and the output of job instruction, and information is carried out the transmission of data through RS2 32 serial ports, is composed of special port drivers, realize the control to port through Control-Menu.Pass through interface module; The user can be the robot model of other CAD software moulding; In the data importing platform that spraying task data and scanning obtain; After handling, data are stored into the spray robot model database respectively and spray in assignment database two sub-module, so that when trajectory planning and demonstration, call.After the robot manipulating task command file generates, follow the communication protocol of this model robot, send it in the robot controller through communication and interface module, realize the Long-distance Control of Control During Paint Spraying by Robot operation.

The implementation method of industrial robot motion planning of the present invention and Performance Test System is characterized in that comprising following process:

1) DBM is used for the storage and management of implementation model data and spraying information, and system is saved in them in the database after the moulding data that obtain spraying task data and robot automatically; Through the spray gun trajectory planning, obtain one and can make the best and satisfied spray gun track that retrains of spraying effect, deposit track data in database; Through inverse robot kinematics and Dynamic solving, obtain joint of robot track and the joint moment corresponding with the spray gun track, deposit it in database; Simultaneously, DBM not only can be stored data, can also accomplish basic management function;

2) human-computer interaction module is realized the input of system's required various parameters in running and to the control of other module, the user can also add the program translation function in this module.In the process of robot simulation and analysis and trajectory planning, need the user relevant parameters to be set through man-machine interface; The code generation also needs the user to send instruction through man-machine interface with the execution of communicating by letter with transport module; When the user imports the robot of new model through communication with interface module; Can add corresponding language generation program through the documents editing window of this module simultaneously; This module can also be packed the program of adding automatically, as the part of robot manipulating task instruction generation module.

3) spray gun trajectory planning module realizes making the automatic generation of the best spray gun track of spraying effect, at first, after the spray gun track is accomplished modeling, transfers by the CAD moulding data of spraying object, sets up paint thickness growth model in the spraying process.As the standard of estimating the spraying effect quality, set up cost functional with the variance of film thickness, algorithm for design is asked for the minimum of cost functional, and then obtains the space tracking of a spray gun motion; Then, according to the setting of user to spray parameters, this track is carried out suitable optimization, utilization robot kinematics principle is obtained and is optimized the corresponding joint motions track of spray gun track; After analysis and emulation, check whether this track satisfies all constraintss of paint finishing, if the point that has does not satisfy constraint; Adjust corresponding tracing point, emulation and analysis again is up to obtaining satisfied result; System provides the method for another kind of planning again on the basis of above trajectory planning, promptly get and optimize the characteristic point that satisfies constraint on the spraying profile, asks for the corresponding joint variable of characteristic point; To its interpolation, whether spraying effect meets the demands with analyzing relatively through emulation again, if do not satisfy the spraying requirement; Then increase the number of characteristic point, recomputate, emulation; As still can not obtain satisfied effect, and then need suitably to revise characteristic point, meet the demands up to spraying effect;

4) analyze that will to accomplish with display module be the workpiece cad data that transmits according to above-mentioned each module, robot model's data, spray gun track and joint of robot track data; The various parameters of the position of spraying task and spray gun; The graphical coating situation that shows spray gun surface of the work when path planning sprays, and provide the average thickness and the deviation data thereof of paint film on the surface of the work with tabular form, the user can also observe joint angle in this process; Joint velocity; The change curve of joint angle speed and joint moment checks whether it satisfies constraints, and whether the situation of robot collision workpiece takes place; So that revise spray gun parameter, path repeatedly, finally obtain satisfied spraying effect;

5) robot manipulating task instruction generation module is used to realize the generation of robot work order; Read machine person joint track data from database at first; Generate the joint pulse,, find the code generation module that is complementary automatically with this model robot in the robot type of choosing based on human-computer interaction module; Generate robot working document and preservation; If the new robot model of adding of user, this module can also be transferred the program conversion module corresponding with this robot model of new interpolation, the automatic generation of completion code file automatically;

6) communication and interface module have realized the information transmission between platform inside and the outside; Read spraying object and robot model's cad data in the outside CAD modeling software database through this module; And it is imported in the self database; Can also import task data and robot data that scanning obtains in the DBM into, for above-mentioned module provides the parameter foundation; This module can also import to the spraying operation file that the job instruction generation module generates in the robot controller, realizes the Long-distance Control of robot.

System of the present invention is with respect to traditional teach programming system, and program speed is fast, and the degree of accuracy is high, and programming is that off-line carries out, and does not take the working time of robot, and production efficiency is high.Traditional teach programming generally depends on teaching workman manual operation machine people, obtains spraying profile, and system of the present invention is on the basis of spraying task model, the spraying profile that draws by computer, thereby operating efficiency and the degree of accuracy all can improve greatly.And when off-line programing, robot still can work on, and both are independent of each other, for robot has saved the valuable working time.With respect to spray robot off-line programing system in the past, the outstanding feature of system of the present invention is perfect in shape and function.It can carry out off-line programing to the robot of multiple model; Generate the job file of different language; To robot different method for planning track and interpolation methods is provided again with a kind of model; And performance evaluation system that can be through synthesization is to the spraying effect that various interpolation method produced, energy consumption, and spray time compares.Therefore both can be used as scientific research, can be used for the control of actual spraying operation system again.Another characteristics of system of the present invention are highly versatiles, and the user not only can carry out off-line programing to the robot type that platform provided, and can also constantly add new robot type and corresponding with it language conversion module according to the needs of oneself.Therefore, the off-line programing that can be used for various model robot.The present invention is that a kind of design is ingenious, function admirable, convenient and practical industrial robot motion planning and Performance Test System and its implementation.

Description of drawings

Fig. 1 is a theory diagram of the present invention.

Fig. 2 is the schematic diagram of implementation method of the present invention.

The specific embodiment

Embodiment:

Structural representation of the present invention is as shown in Figure 1; Below in conjunction with accompanying drawing instance of the present invention is described; Present embodiment is as technical scheme with content of the present invention; Realizing the off-line programing of MOTOMAN robot, is an application of the present invention, has provided the specific operation process of present embodiment below.

As shown in Figure 1, the involved part of present embodiment has: MOTOMAN robot (figure is last not to be drawn) and controller thereof, the comprehensive platform of spray robot off-line programing of the present invention, communication cable etc.

The comprehensive platform of spray robot off-line programing comprises six main functional modules in this instance: DBM, and human-computer interaction module, spray gun trajectory planning module is analyzed and display module, job file generation module, communication and interface module.DBM is realized the storage of MOTOMAN robot spray gun track and joint variable and spraying task.Human-computer interaction module is realized the input of parameter and to the control of other module.Spray gun trajectory planning module is used under the prerequisite that satisfies all spraying constraints, cooks up one and makes the best spray gun track of spraying effect, and obtain the corresponding joint variable of this track.Analyze the simulation and analysis of realizing MOTOMAN Control During Paint Spraying by Robot process with display module.The job file generation module is realized MOTOMAN robot working document systematic function.Communication and interface module be used to spray task data importing and job file upload download.

DBM described in this instance reads spraying during task data in interface CAD moulding database from the outside, can realize reading the acceptance of data, and it is deposited in the spraying assignment database.In trajectory planning, we can obtain one and satisfy constraints and the best spray gun track joint variable corresponding with this track of spraying effect, and database is also realized the storage of these data and management.

Said human-computer interaction module is realized various spray parameters settings.In this example, we only need to select the type of robot, the spraying task, and the method for trajectory planning and interpolation is provided with the position in the rectangular co-ordinate space of spraying task, and other is provided with the default value of option employing platform.

Said spray gun trajectory planning module realizes the automatic generation of the spray gun track that spraying effect is best.According to the setting of man-machine interface, this instance adopts the trajectory planning in joint coordinates space, at first on the basis of spraying task model; Set up paint thickness growth model and the cost functional of estimating spraying effect in the spraying process; Try to achieve the spray gun track of spraying effect preferably the time through the minimax value-based algorithm, choose the characteristic point of track, whether judging characteristic point is in the working space of robot; The point in working space is not chosen again, all satisfied this condition to guarantee all characteristic points.Invert through kinematics and to separate and principle of dynamics; Try to achieve the corresponding joint angles of characteristic point, joint angle speed, joint angle acceleration and joint moment; The interpolation method of choosing through man-machine interface; Transfer corresponding interpolation algorithm joint angles is carried out interpolation, and obtain the joint angle speed of all interpolation points, joint angle acceleration and joint moment.

The joint variable that said analysis and display module realization MOTOMAN robot try to achieve according to trajectory planning is carried out the simulation and analysis of spraying process.Through emulation, we can observe the state of spraying effect and robot in the spraying process, spray the used time, the used energy of spraying process, the average thickness of paint film, deviation and mean square deviation.Click Control-Menu corresponding on the man-machine interface, can also observe the joint torque curve, joint angles curve, joint angle rate curve, joint angle accelerating curve.If parameter dissatisfied to spraying effect or that have does not satisfy constraints, then must increase or the modification characteristic point, carry out kinematics and dynamic (dynamical) calculating and emulation again, till obtaining satisfied result.Spray gun data and joint data deposit in the database the most at last.

Said job file generation module is mainly realized the generation of INFROMII code file.Because MOTOMAN robot working procedure is the INFROMII code; We at first transfer the joint data from the joint trajectories database; Generation module through the joint pulse realizes by the conversion of joint data to the joint pulse value, calls MOTOMAN robot program conversion module again and the joint pulse is changed into the INFROMII code file and is stored in the file of engineering acquiescence.

Said communication and interface module realize the importing of spraying task model and the transmission of job file.When importing sprayed task data, we only needed to click the respective selection of Control-Menu, choose the file that will read in, and platform is the calling interface driver automatically, read the spraying task model data of outside and be stored in to spray in the assignment database.After generating the robot manipulating task file, click the respective selection of Control-Menu, eject and select dialog box; Choose the job file that will transmit; The automatic calling communication driver of platform meeting according to the communication protocol of MOTOMAN robot, is loaded in the robot controller under the job file.

The present invention uses in this example, can carry out according to following steps:

Step 1: obtain the data of spraying object and deposit the spraying assignment database in.This platform provides the multiple method of obtaining the spraying object data.If have in the spraying assignment database by the information of spraying object; Then do not need this step; Otherwise the user can control " obtaining the spraying task " menu on the human-computer interaction interface, chooses will reading in of task; Will from other document or configuration software CAD database, read through communication and interface module, and it is deposited in the spraying assignment database.

Step 2: the threedimensional model that obtains robot.Three kinds of robot models commonly used have been provided through the OpenGL program in the platform: MOTOMAN robot model, PUMA560 robot model, Stamford robot model.And through human-computer interaction interface, the user can be provided with the length of connecting rod of these three kinds of robots, connecting rod quality, and the connecting rod rotary inertia, the maximum rotation moment that each joint can provide, if the user is not provided with them, system can press default value automatically and handle.If the user through the configuration software construction oneself robot model, then can from configuration software CAD database, read, and it is deposited in robot model's database through controlling " obtaining the robot model " menu on the human-computer interaction interface.This instance is selected the MOTOMAN robot model for use, and connecting rod and joint parameter are default value, therefore need outside platform, not import the robot model.

Step 3: man-machine interface setting.On man-machine interface, the user can select the spraying task, robot type, the method for trajectory planning and interpolation; The robot variable is set, environmental variance, spray gun parameter; The performance indications requirement, the parameters such as position of spraying task, these parameters will be called in following steps.If the user is not provided with these parameters, system will adopt default value to carry out simulation and analysis automatically.In this instance, a type to robot, the spraying task, the method for trajectory planning and interpolation, the position in the rectangular co-ordinate space of spraying task is provided with, and other parameter adopts default value.

Step 4: add language coversion program.If in the step 2, imported new robot model, then the program on man-machine interface is added the district; The user can add corresponding language generation module, and platform is packed the language generation module according to programming rule; Add in the work order generation module, so that when generating code, call.In this example, this step does not relate to.

Step 5: the 3-d modelling of robot and working environment.Through the setting of man-machine interface to spraying task and robot type; Display module is transferred corresponding task module and robot module's data automatically from database; The position and other parameter of the spraying task that is provided with according to man-machine interface; Accomplish the modeling of spray gun, show on man-machine interface that with suitable size wherein the position of robot is a default value.The spraying object's position be provided with must satisfy the point that all are sprayed on the object must be in reached at the working space of robot.Otherwise it is more accurate to carry out the position.

Step 6: the trajectory planning in rectangular co-ordinate space.According to the Mathematical Modeling of the 3-d modelling and the spray gun of robot and working environment, set up the growth model of film thickness, set up target model letter with the variance of film thickness as variable again.Trajectory planning is exactly to guarantee that desired coating thickness all is under the constraints of definite value with allowing maximum deviation, and seek one and guarantee that the coating layer thickness variance is minimum, the spray gun track that spray time is the shortest, this is the multi-objective optimization question of a belt restraining.For obtaining the best spray gun track of spraying effect, design of Platform special minimax value-based algorithm find the solution, the spray gun trend of setting according to the user is again carried out parameter optimization to the spray gun track, obtains the spray gun track of an optimization.If the user has selected the method for first kind of trajectory planning; Then only need directly above the optimum spray gun track of trying to achieve carry out inverse robot kinematics and Dynamic solving; If the tracing point that has is not in the working range of robot; After then need carrying out suitable adjustment, obtain corresponding joint variable again, till analysis and emulation obtain satisfied effect to these points.Platform also designed special algorithm to tracing point near or handle through the situation of robot singular point.In this example, do not adopt this method.

Step 7: the trajectory planning in joint coordinates space.If the user selects second kind of method for planning track, need obtain optimum spray gun track equally, get the characteristic point on the optimum spray gun track of robot then; Judge it and whether in the robot working space,, need do suitable adjustment if do not exist; With guarantee the characteristic point of being got all in the robot working space; Obtain the corresponding joint variable of characteristic point through the inverse robot kinematics again, the interpolation method according to the user selects calls interpolating module joint variable is carried out interpolation arithmetic.Through emulation,, increase or the modification characteristic point, up to obtaining satisfied spraying effect if index does not satisfy the spraying requirement.This instance adopts this method for planning track exactly.

Step 8: the dynamic simulation of spraying process.(joint variable of trying to achieve for step 7) in this instance passes in the virtual reality of step 5 generation, through spraying Control-Menu control process of simulation with step 6 or 7.Emulation is accomplished, and observes whether mechanical hand collision workpiece, the length of spray time, the variance yields of film thickness take place in the spraying process.Click the corresponding option of spraying Control-Menu, can also selectively observe joint trajectories, joint velocity, the joint acceleration, the curve of joint torque is analyzed them and whether is satisfied constraints.If do not meet the demands, repeating step 6 or 7 (is step 7) in this instance, till obtaining satisfied spraying effect.

Step 9: the storage of joint trajectories.If each item index of spraying process all meets the demands, click " preserving the joint motions track " in the spraying Control-Menu, system deposits the joint motions track of robot in the joint trajectories database automatically.

Step 10: robot code generates.The joint trajectories that will be kept in the joint of robot trajectory if desired changes into robot code.At first click " robot code generation " item in the Control-Menu; System can transfer the joint data automatically from database; Through the pulses switch program, these data transaction are become the joint pulse, the direction of the positive negative indication joint rotation of pulse amplitude; The density of pulse is represented the speed of velocity of rotation, and the number of pulse is represented the size of rotational angle.Then, call and the corresponding job instruction conversion module of robot model, the joint pulse is changed into the robot manipulating task file, be kept under the catalogue of engineering acquiescence.

Step 11: the transmission of robot manipulating task instruction.In the spraying Control-Menu on the human-computer interaction interface, click " robot manipulating task file transfer " button; System can jump out an Option Box; Let the user select the job file that will transmit; After selection and the click " confirming ", system can be transferred to the robot manipulating task command file that generates in the ROBOT CONTROL device through automatic calling interface driver driving interface.

Claims (10)

1. industrial robot motion planning and Performance Test System; It is characterized in that including the storage and management that is used for implementation model data and information DBM (1), running realize will required various parameters input and to the human-computer interaction module (2) of the control of other module, automatically generate the spray gun trajectory planning module (3) of the spray gun track that makes spraying effect the best, graphically show the coating situation of spray gun surface of the work when path planning sprays; And the analysis of average thickness and deviation data thereof that provides paint film on the surface of the work with tabular form with display module (4), be used to realize the generation of robot work order robot manipulating task instruction generation module (5), realize the communicating by letter and interface module (6) of information transmission between inside and the outside; After the user sends the control instruction that imports robot or spraying task data through human-computer interaction module (2) to communication and interface module (6), communication and interface module (6) according to the instruction type of human-computer interaction module (2) with the robot model of outside or spray task data and deposit in the corresponding subdata base in the DBM (1); Method for planning track, interpolation method control information and relative position, spray gun angular aperture parameter that spray gun trajectory planning module (3) is transmitted according to human-computer interaction module (2); The robot model and spraying task data that transmit according to DBM (1) accomplish trajectory planning again; When human-computer interaction module (2) to analyzing when sending the control instruction that begins to spray with display module (4); Analyze with display module (4) and can the joint variable that obtain in the spray gun trajectory planning module (3) be called in; From DBM (1), read in robot model and spraying task data simultaneously; From human-computer interaction module (2), obtain corresponding spray parameters, carry out the demonstration of spraying process; After obtaining satisfied spraying effect, human-computer interaction module (2) will send the control instruction of storage joint variable to DBM (1), and the joint variable that best spraying effect is corresponding deposits in the DBM (1); After human-computer interaction module (2) sends the order that generates the robot manipulating task instruction to robot manipulating task instruction generation module (5); Robot manipulating task instruction generation module (5) is transferred the joint variable in the DBM (1); The generation that fulfils assignment and instruct; If added new robot model, the transcode of importing through human-computer interaction module (2) will join in the robot manipulating task instruction generation module (5) automatically; When human-computer interaction module (2) sends when downloading code command to communication and interface module (6), the robot manipulating task instruction that robot manipulating task instruction generation module (5) generates will be delivered in the robot controller through communication and interface module (6) and communication cable.
2. industrial robot motion planning according to claim 1 and Performance Test System; It is characterized in that above-mentioned DBM (1) comprises spraying task data library module; The spray robot model module, spraying profile DBM, joint trajectories DBM; The joint moment DBM; Spraying task data library module is used to deposit the cad data through object after the moulding, or the data of other CAD systems that read through interface, also can be through scanning the model data that material object obtains; The spray robot model module is used to store robot model's data that the user imports through interface; The spraying profile database module stores be to satisfy the best spraying profile of spraying effect under the prerequisite of constraints, the joint trajectories DBM is deposited to invert through kinematics and is separated the different rotational angles constantly in each joint of robot that obtain, angular speed passes through the joint trajectories that is generated after the different interpolation processing with angular acceleration or characteristic point; Joint velocity and angular speed, joint moment DBM are realized the different storages of joint moment constantly in each joint of robot.
3. industrial robot motion planning according to claim 2 and Performance Test System is characterized in that above-mentioned DBM (1) comprises the Administration menu of database, and Administration menu is realized the effective management to different objects in the database; Comprise interpolation; Memory function is revised in deletion.
4. industrial robot motion planning according to claim 1 and Performance Test System is characterized in that above-mentioned human-computer interaction module (2) comprises that spray parameters is provided with module, control module and program editing module; Through spray parameters module is set, the user can be provided with robot parameter, spray parameters; The method of trajectory planning and interpolation, the angular aperture of spray gun, environmental variance parameter are in control module; Whether the user can pass through menu, whether controls running job instruction generation module, the instruction code file that generates is sent in the robot controller through communication and interface module; And whether import extraneous spraying task and robot model's data, and can also check the curve of joint variable through clicking menu option, the program editing module is to aim to increase robot manipulating task Programming with Pascal Language rule and the open interface of design; The user imports new robot model through communication and interface module; Can pass through the program editing interface, follow the syntax rule of the corresponding language of this robot model, add the code conversion module.
5. industrial robot motion planning according to claim 1 and Performance Test System is characterized in that above-mentioned spray gun trajectory planning module (3) comprises planning of rectangular co-ordinate space tracking and the planning of joint coordinates space tracking; The foundation of paint thickness growth model and the cost functional of estimating spraying effect in the rectangular co-ordinate space tracking planning realization spraying process; Ask for the extreme value of cost functional through the minimax value-based algorithm; Automatically generation can make the best spray gun track of spraying effect, in addition, can also the spray gun trend of setting in the module be set according to spray gun; The spray gun track is carried out parameter optimization; The spray gun track that is optimized is at last obtained the joint of robot track according to the kinematics method of separating of inverting, and realizes the conversion from the rectangular co-ordinate space to the joint coordinates space; Because some that possibly occur on the optimum spray gun track put the not situation in the robot working space; Therefore must just can obtain satisfied spray gun track through adjustment and emulation repeatedly, the joint coordinates space tracking plans it is on the basis of rectangular co-ordinate space tracking planning, to accomplish, and at first obtains the spray gun track of optimization through the planning of rectangular co-ordinate space tracking; Then; The track characteristic point of constraints is satisfied in taking-up, obtains the corresponding joint variable of characteristic point, adopts different interpolation methods that joint variable is carried out interpolation arithmetic again; Through emulation and analysis, the user can select a kind of interpolation method that relatively is suitable for this spraying task; If dissatisfied to spraying effect, can get the characteristic point that some satisfy constraint more, if increase characteristic point simply still can not obtain satisfied spraying effect, then need revise some characteristic points, till obtaining satisfied spraying effect.
6. industrial robot motion planning according to claim 5 and Performance Test System; It is characterized in that above-mentioned interpolation arithmetic comprises the cubic polynomial interpolation; Cross the cubic polynomial interpolation of path point, five order polynomials carry out interpolation, with the linear interpolation of parabolic transition; Cross the linear interpolation with parabolic transition of path point, three rank B spline interpolations.
7. industrial robot motion planning according to claim 1 and Performance Test System; It is characterized in that above-mentioned analysis and display module (4) comprise robot model's demonstration; The demonstration of spraying task; The demonstration of robot motion's situation and spraying effect in the spraying process, the demonstration of the curve of joint variable, the demonstration of spray time; The data that this display module is provided according to above DBM (1) by the state of spraying object and robot, show the Changing Pattern of joint variable variable in the real-time simulation spraying process; And with the tabulation form provide the used energy of spraying process, the average thickness of paint film, deviation and mean square deviation; Whether motion and torque to make things convenient for each joint of customer inspection robot satisfy its constraints; Whether the situation of manipulator collision workpiece takes place, and off-line is observed the terminal accessibility of spray gun, and relatively the method time spent of which kind of trajectory planning is the shortest; Consumed energy is minimum; Which kind of interpolation method is the most reasonable, be modification spray gun parameter, path, and then the best spraying effect of acquisition provides foundation.
8. industrial robot motion planning according to claim 1 and Performance Test System; It is characterized in that above-mentioned robot manipulating task instruction generation module (5) comprises the read module of joint data; The generation module of joint pulse; Choosing and generation module of language conversion module, the read module of joint data is accomplished the task of from DBM (1), reading the joint data; The generation module of joint pulse is realized by the conversion of joint data to the joint pulse value; The language conversion module choose and generation module is accomplished and the choosing automatically of the robot corresponding language conversion module of model; And realize by the conversion of joint pulse to robot language; Generate the necessary job instruction of robot motion; For obtaining general test macro, this robot manipulating task instruction generation module (5) has adopted open programmed method, except the language conversion module of platform provided three kinds of model commonly used robots; The user can pass through modular programming mode, adds and the robot model's corresponding programs conversion module that oneself imports at robot language Transformation Program editing area; At last; This robot manipulating task instruction generation module (5) is selected corresponding with it language conversion module, through calling the joint data joint trajectories that is stored in DBM (1) the joint trajectories database automatically according to the set robot type of user; Accomplish of the conversion of joint data joint trajectories to the joint pulse; According to grammar request, generate the job instruction file, and it is kept in the special-purpose project file folder.
9. based on described industrial robot motion planning of claim 1 and Performance Test System; It is characterized in that above-mentioned communication and interface module (6) comprise the input of model data and the output of job instruction; Information is carried out the transmission of data through the RS232 serial ports; Be composed of special port drivers, realize control port through Control-Menu; Through communication and interface module (6); The user can be the robot model of other CAD software moulding; In the data importing test macro that spraying task data and scanning obtain; After handling, data are stored into the spray robot model database respectively and spray in assignment database two sub-module, so that when trajectory planning and demonstration, call; After the robot manipulating task command file generates, follow the communication protocol of this model robot, send it in the robot controller through communication and interface module, realize the Long-distance Control of Control During Paint Spraying by Robot operation.
10. the implementation method of industrial robot motion planning according to claim 1 and Performance Test System is characterized in that comprising following process:
1) DBM (1) is used for the storage and management of implementation model data and spraying information, and system is saved in them in the database after the moulding data that obtain spraying task data and robot automatically; Through the spray gun trajectory planning, obtain one and can make the best and satisfied spray gun track that retrains of spraying effect, deposit track data in database; Through inverse robot kinematics and Dynamic solving, obtain joint of robot track and the joint moment corresponding with the spray gun track, deposit it in database; Simultaneously, DBM not only can be stored data, can also accomplish basic management function;
2) input of human-computer interaction module (2) realization system required various parameters in running and to the control of other module, the user can also be in this human-computer interaction module (2) interpolation program translation function; In the process of robot simulation and analysis and trajectory planning, need the user relevant parameters to be set through man-machine interface; Robot manipulating task instruction generation module (5) also needs the user to send instruction through man-machine interface with the execution of communicating by letter with interface module (6); When the user imports the robot of new model through communication with interface module; Can add corresponding language generation program through the documents editing window of this human-computer interaction module (2) simultaneously; This human-computer interaction module (2) can also be packed the program of adding automatically, as the part of robot manipulating task instruction generation module;
3) spray gun trajectory planning module (3) realizes making the automatic generation of the best spray gun track of spraying effect, at first, after the spray gun track is accomplished modeling, transfers by the CAD moulding data of spraying object, sets up paint thickness growth model in the spraying process; As the standard of estimating the spraying effect quality, set up cost functional with the variance of film thickness, algorithm for design is asked for the minimum of cost functional, and then obtains the space tracking of a spray gun motion; Then, according to the setting of user to spray parameters, this spray gun track is carried out suitable optimization, utilization robot kinematics principle is obtained and is optimized the corresponding joint motions track of spray gun track; After analysis and emulation, check whether this track satisfies all constraintss of paint finishing, if the point that has does not satisfy constraint; Adjust corresponding tracing point, emulation and analysis again is up to obtaining satisfied result; System provides the method for another kind of planning again on the basis of above trajectory planning, promptly get and optimize the characteristic point that satisfies constraint on the spray gun track, asks for the corresponding joint variable of characteristic point; To its interpolation, whether spraying effect meets the demands with analyzing relatively through emulation again, if do not satisfy the spraying requirement; Then increase the number of characteristic point, recomputate, emulation; As still can not obtain satisfied effect, and then need suitably to revise characteristic point, meet the demands up to spraying effect;
What 4) analysis and display module (4) will be accomplished is the workpiece cad data that transmits according to above-mentioned each module, robot model's data, spray gun track and joint of robot track data; The various parameters of the position of spraying task and spray gun; The graphical coating situation that shows spray gun surface of the work when path planning sprays, and provide the average thickness and the deviation data thereof of paint film on the surface of the work with tabular form, the user can also observe joint angle in this process; Joint velocity; The change curve of joint angle speed and joint moment checks whether it satisfies constraints, and whether the situation of robot collision workpiece takes place; So that revise spray gun parameter, path repeatedly, finally obtain satisfied spraying effect;
5) robot manipulating task instruction generation module (5) is used to realize the generation of robot work order; Read machine person joint track data from database at first; Generate the joint pulse, the robot type of choosing based on human-computer interaction module again finds the code generation module that is complementary with this model robot automatically; Generate robot working document and preservation; If the new robot model of adding of user, this robot manipulating task instruction generation module (5) can also be transferred the program conversion module corresponding with this robot model of new interpolation, the automatic generation of completion code file automatically;
6) communication and interface module (6) have realized the information transmission between test macro inside and the outside; Read spraying object and robot model's cad data in the outside CAD modeling software database through this communication and interface module (6); And it is imported in the self database; Can also import task data and robot data that scanning obtains in the DBM (1) into, for above-mentioned DBM (1) provides the parameter foundation; This communication and interface module (6) can also import to the spraying operation file that the job instruction generation module generates in the robot controller, realize the Long-distance Control of robot.
CN2010100194507A 2010-01-15 2010-01-15 Industrial robot motion planning and performance testing system and implementation method thereof CN101791801B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN2010100194507A CN101791801B (en) 2010-01-15 2010-01-15 Industrial robot motion planning and performance testing system and implementation method thereof

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN2010100194507A CN101791801B (en) 2010-01-15 2010-01-15 Industrial robot motion planning and performance testing system and implementation method thereof

Publications (2)

Publication Number Publication Date
CN101791801A CN101791801A (en) 2010-08-04
CN101791801B true CN101791801B (en) 2012-06-06

Family

ID=42584824

Family Applications (1)

Application Number Title Priority Date Filing Date
CN2010100194507A CN101791801B (en) 2010-01-15 2010-01-15 Industrial robot motion planning and performance testing system and implementation method thereof

Country Status (1)

Country Link
CN (1) CN101791801B (en)

Families Citing this family (23)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102011010505A1 (en) 2011-02-07 2012-08-09 Dürr Systems GmbH Adaptation of the dynamics of at least one robot
PL2637114T3 (en) * 2012-03-07 2019-06-28 Cideon Software & Services Gmbh & Co. Kg Method for coupling a CAD system with a database and planning system for exchanging data between both systems
DE102012015437A1 (en) * 2012-08-02 2014-05-15 Kuka Roboter Gmbh Method and programming means for modifying a robot path
CN103802113A (en) * 2012-11-08 2014-05-21 沈阳新松机器人自动化股份有限公司 Industrial robot route planning method based on task and spline
CN103085072B (en) * 2013-03-11 2014-10-29 南京埃斯顿机器人工程有限公司 Method for achieving industrial robot off-line programming based on three-dimensional modeling software
CN105034000B (en) * 2015-07-13 2017-02-01 浙江大学 Industrial robot imaging control system based on CAD import
CN105479468B (en) * 2015-12-29 2018-02-09 浙江瑞鹏机器人科技有限公司 A kind of tele-robotic motion controller
CN106060058A (en) * 2016-06-16 2016-10-26 华南理工大学 Internet-based industrial robot remote control method
CN106078753A (en) * 2016-06-30 2016-11-09 珠海格力智能装备有限公司 A kind of robot demonstrator and the information processing method of robot demonstrator
CN106607293A (en) * 2016-12-19 2017-05-03 徐州赛欧电子科技有限公司 Painting robot and control method thereof
CN107081787B (en) * 2017-04-01 2019-09-20 西安交通大学 Kinetic characteristic detection method based on industrial robot built-in sensors signal
JP6445092B2 (en) * 2017-05-31 2018-12-26 ファナック株式会社 Robot system displaying information for teaching robots
WO2019000181A1 (en) * 2017-06-26 2019-01-03 深圳配天智能技术研究院有限公司 Robotic manipulator control device and method, and robot system
CN107463163A (en) * 2017-07-21 2017-12-12 芜湖赛宝机器人产业技术研究院有限公司 A kind of Novel industrial robot controller performance test system
CN107696020A (en) * 2017-11-24 2018-02-16 国电锅炉压力容器检验中心 The control method and control device of six axis robot and its turntable that links
CN108789426A (en) * 2017-12-29 2018-11-13 金门工程建设有限公司 The mechanical people of surface treatment
CN108436911A (en) * 2018-03-23 2018-08-24 海安诚益机器人有限公司 A kind of industrial robot
CN108515290B (en) * 2018-03-30 2019-12-03 宁波高新区神台德机械设备有限公司 Industrial robot action detection device
CN108945677A (en) * 2018-06-22 2018-12-07 苏州朵唯智能科技有限公司 A kind of label embedment method using robot
CN108994851B (en) * 2018-08-07 2020-07-24 王保山 Intelligent polishing method of manipulator and intelligent polishing manipulator system
WO2020132903A1 (en) * 2018-12-25 2020-07-02 深圳配天智能技术研究院有限公司 Robot program instruction compiling method, robot control system and storage device
CN110448919A (en) * 2018-12-28 2019-11-15 东莞市诺诚自动化科技有限公司 A kind of full-automatic hair implanter coordinate transformation method controlled based on programming
WO2020215213A1 (en) * 2019-04-23 2020-10-29 西门子股份公司 Multi-axis motion controller, multi-axis motion control method and system

Also Published As

Publication number Publication date
CN101791801A (en) 2010-08-04

Similar Documents

Publication Publication Date Title
CN104965517B (en) A kind of planing method of robot cartesian space track
Hewit et al. Fast dynamic decoupled control for robotics, using active force control
Yau et al. Fast Bezier interpolator with real-time lookahead function for high-accuracy machining
Kang et al. Planning and visualization for automated robotic crane erection processes in construction
Xu Machine Tool 4.0 for the new era of manufacturing
CN106874914A (en) A kind of industrial machinery arm visual spatial attention method based on depth convolutional neural networks
US8000818B1 (en) Systems and methods for coordination motion instructions
US8401698B2 (en) Method for optimising the performance of a robot
CN106457565B (en) Method and system for programming a robot
CN104834309B (en) The optimal touring control method of single mobile robot based on target following control strategy
CN106426164B (en) A kind of multi objective coordinated movement of various economic factors planing method of redundancy double mechanical arms
CN104552300B (en) A kind of off-line programing teaching apparatus based on teaching robot and method
EP1643327B1 (en) Systems and methods that facilitate motion control through coordinate system transformations
DE102012218297A1 (en) Method for dynamically optimizing a robot control interface
Miller Sensor-based control of robotic manipulators using a general learning algorithm
CN104699122B (en) A kind of robot movement-control system
Braumann et al. Parametric robot control: integrated CAD/CAM for architectural design
CN105068427B (en) A kind of multi-robot system finite time robust cooperates with tracking and controlling method
CN100460159C (en) Off line programming tool for industrial robot
CN107363812B (en) Wireless control six-degree-of-freedom mechanical arm demonstration system
US20110054685A1 (en) Robot off-line teaching method
CN104841593A (en) Control method of robot automatic spraying system
EP3126101A1 (en) Software interface for authoring robotic manufacturing process
CN104440864B (en) A kind of master-slave mode remote operating industrial robot system and its control method
CN101739865B (en) PLC-based two-dimensional motion demonstration platform for teaching and implementation method thereof

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
C10 Entry into substantive examination
GR01 Patent grant
C14 Grant of patent or utility model
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20120606

Termination date: 20130115