CN101791801B - Industrial robot motion planning and performance testing system and implementation method thereof - Google PatentsIndustrial robot motion planning and performance testing system and implementation method thereof Download PDF
- 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
- Prior art keywords
- Prior art date
- 238000005507 spraying Methods 0.000 claims abstract description 156
- 239000007921 sprays Substances 0.000 claims abstract description 129
- 230000000694 effects Effects 0.000 claims abstract description 52
- 230000000875 corresponding Effects 0.000 claims abstract description 41
- 230000003993 interaction Effects 0.000 claims abstract description 39
- 238000004891 communication Methods 0.000 claims abstract description 34
- 238000000034 methods Methods 0.000 claims abstract description 32
- 238000004458 analytical methods Methods 0.000 claims abstract description 20
- 238000003860 storage Methods 0.000 claims abstract description 10
- 238000006243 chemical reactions Methods 0.000 claims description 27
- 239000003973 paint Substances 0.000 claims description 17
- 238000000465 moulding Methods 0.000 claims description 9
- 238000005457 optimization Methods 0.000 claims description 9
- 241000563994 Cardiopteridaceae Species 0.000 claims description 8
- 230000005540 biological transmission Effects 0.000 claims description 8
- 238000004088 simulation Methods 0.000 claims description 8
- 230000001133 acceleration Effects 0.000 claims description 5
- 239000011248 coating agents Substances 0.000 claims description 5
- 238000000576 coating method Methods 0.000 claims description 5
- 230000004048 modification Effects 0.000 claims description 4
- 238000006011 modification reactions Methods 0.000 claims description 4
- 280000965867 Communication Cable companies 0.000 claims description 3
- 239000000463 materials Substances 0.000 claims description 3
- 230000000295 complement Effects 0.000 claims description 2
- 238000007689 inspection Methods 0.000 claims description 2
- 230000014759 maintenance of location Effects 0.000 claims description 2
- 238000004321 preservation Methods 0.000 claims description 2
- 230000001131 transforming Effects 0.000 claims description 2
- 281000082337 Motoman companies 0.000 description 12
- 239000000203 mixtures Substances 0.000 description 3
- 238000010586 diagrams Methods 0.000 description 2
- 238000005516 engineering processes Methods 0.000 description 2
- 238000004519 manufacturing process Methods 0.000 description 2
- 280000314319 Ferguson companies 0.000 description 1
- 238000005267 amalgamation Methods 0.000 description 1
- 239000011247 coating layers Substances 0.000 description 1
- 238000005094 computer simulation Methods 0.000 description 1
- 230000001276 controlling effects Effects 0.000 description 1
- 238000005265 energy consumption Methods 0.000 description 1
- 238000003754 machining Methods 0.000 description 1
- 230000000644 propagated Effects 0.000 description 1
- 230000000452 restraining Effects 0.000 description 1
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.
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
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.
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|
|Publication Number||Publication Date|
|CN101791801A CN101791801A (en)||2010-08-04|
|CN101791801B true CN101791801B (en)||2012-06-06|
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)
|CN (1)||CN101791801B (en)|
Families Citing this family (23)
|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|
- 2010-01-15 CN CN2010100194507A patent/CN101791801B/en not_active IP Right Cessation
Also Published As
|Publication number||Publication date|
|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|
|SE01||Entry into force of request for substantive examination|
|C10||Entry into substantive examination|
|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