CN1344600A - Opened industrial robot controlling platform - Google Patents

Abstract

The controlling platform for opened industrial robot is one universal industrial robot controlling system. The present invnetion is featured by that universal industrial computer is introduced into traditional robot controlling system and that by means of unique opened and modular structure, the original controller in closed structure is expanded into controlling platform in opened structure. As one robot controlling system for controlling different servo packages, controlling industrial robot move flexibly and increasing funcitons conveniently, the present invcntion can make the robot production suitable for the requirement of small order and multiple variety production in modern industrial.

Description

Opened industrial robot controlling platform

The invention belongs to the general-purpose industrial robot control system.Its outstanding feature is that the general-purpose industrial computing machine is introduced in traditional robot control system, and adopts unique open and modular construction, the controller of original structure sealing is expanded to the control platform of structure opening.

Traditional industry robot controller (CONTROLLER) lacks independence, ROBOT CONTROL device and manipulator (MANIPULATOR) are one, Figure 1 shows that the Typical Disposition of traditional robot control system, R1 is an industrial robot, A1 is a controller, the inside is integrated with special purpose computer and some other electric equipment of servo bag, structure sealing, controller wherein generally can only be suitable for the fixing a kind of servo bag of a certain model, drag a certain specific servomotor, sort controller generally also can only be applicable to a kind of particular machines people.The function of controller depends on required finishing of the task of robot, and the used parameter of servo and planning algorithm of controller is all directly from body: low layer position servo algorithm will customize according to the servomotor of manipulator and the characteristic of servoamplifier, and the upper strata planning procedure will be worked out according to parameters such as the mechanism of manipulator, sizes.

If job task and manipulating object are all fixed, so this closed robot controller has simply, advantage reliably and efficiently.But along with expanding economy, people are more and more higher to the diversified requirement of product.Make already by original task and the operation of the relatively-stationary large-scale pipeline formula of object, to the flexible manufacturing (FM) and computer integrated manufacturing system (CIM) mode development of task and the frequent middle and small scale that changes of object.The task that this industrial robot that just requires to take in the system manufacturing system formerly fresh combatants can be competent at continuous variation, i.e. function flexibilityization.In the purchase stage of robot, the user of robot can not to future production task variation consider comprehensively.In case new task is not included in the existing ROBOT CONTROL function, the controller robot that has enclosed construction so just has no purposes like this.In addition, the configuration of original robot control system as shown in Figure 1, wherein the model of the R1 of robot is fixed.

Purpose of the present invention is as follows: if the function of robot can be expanded, through the function expansion of controller, original robot just can put in the new production task and go.And if the function of controller has expandability, the software and hardware that just needs controller all is open.The software opening is because new function needs new control strategy and new control method; The hardware opening is that new device need communicate with controller, so controller hardware must be open because new task needs new device.Make robot have flexibility, controller must be a structure opening.The present invention can be used as a kind of control system of robot, control polytype servo bag, control industrial robot more neatly, increase its function more easily, make existing robots produce the requirement that further adapts to the many kinds of modern industry production short run; Also can be used as a kind of experiment porch,, test various control strategies, for the research and the exploitation of futurity industry robot provides a kind of experiment porch by the Control Software of layer exploitation thereon based on different operating system.

Technical essential of the present invention is as shown in Figure 2: I1 is the general-purpose industrial computing machine, and A2 is a switch board, and servo bag and main frame are installed in wherein, and R2 is an industrial robot.With different be of Fig. 1 in configuration: increased external industrial computer, made the user can be according to own actual needs establishment and modification control program, the model of the R2 of robot among Fig. 2 can be selected for use flexibly.

Technological core of the present invention is to realize the control of a kind of controller to multiple servo bag by industrial computer and some interface boards.Fig. 3 is concrete connection diagram, C1 is multi-axis motion controller PMAC2-PCR (being called for short PMAC) among the figure, it can be inserted on the slot of the isa bus on the industrial computer, C2 and C3 are YASKAWA absolute encoder converter ACC-8D-OPTION9, C4 is Signal Matching converter ACC-8E, and C5 also is Signal Matching converter ACC-8F; S1 is respectively the different servo bags of two classes with S2, and S1 is the imported servo bag of voltage signal, and input voltage is 0-6V, and S2 is the imported servo bag of PWM, is input as the PWM ripple; M1 and M2 are servomotor, and E1 and E2 are respectively the code-disc signal output unit (ENCODER) of M1 and M2.

The principle of work of Fig. 3 is as follows:

Send voltage control signal by operating in the control program of working out on the industrial computer, send C4 to by the JMAC2 interface on the C1, send servo bag S1 by C4 to through amplifying again, and then the driving pulse of formation servomotor M1, computing machine is also controlled PMAC and is produced another road pwm signal in addition, and pass to interface board C5 by JMAC4, and export to the servo bag S2 that needs the PWM input signal by the P5 port of C5 again, the drive signal of servomotor M2 is just from S2.

Robot control system also needs the variation of the position in each joint of definite robot in addition, and this signal is to produce by the code-disc that is installed on the servomotor, because servo bag is inequality, so the pipeline of code-disc signal also is different.The code-disc signal of the M1 that is produced by E1 is given S1 earlier, and EO (ENCODE OUTPUT) port by S1 passes to absolute encoder converter C2 again, and C2 is the increment code wheel signal with the absolute encoder conversion of signals, and absolute encoder signal and increment code wheel signal are all passed PMAC back; And the code-disc signal of M2 is to be directly passed to C3 after being produced by E2, and the signal of C3 produces absolute signal and increment signal respectively through C2 and C5 again, and finally is aggregated into PMAC by JMAC1 on the PMAC and JMAC4.Computing machine has just obtained the code-disc signal of two kinds of servomotors like this, just can understand these code-disc signals by computer program, to determine the position and the motion state in each joint of robot.

By the connection of above circuit, just can realize easily providing control signal, and can understand the code-disc signal of two kinds of different servo motors to two kinds of different servo bags, can control this two classes servomotor very neatly.In like manner also can expand to the control of many servomotors.

The major advantage of the robot controlling platform that the present invention proposes is as follows: a cover control system can be controlled many servo bags simultaneously; Owing to adopted complete open structure, the user can carry out secondary development according to technological requirement on the basis of this control system, finish the not available task of some original systems; Because industrial computer has been introduced in the ROBOT CONTROL system, the user is the manipulation robot more neatly, carries out teaching and reproduces, and have very friendly man-machine interface; This cover control system can realize at most the controls of 8 motions are compared with 6 axis controllers that present industrial robot generally uses, and has higher control accuracy and application widely; Because robot body, servo bag, motion controller and industrial computer among the present invention all adopt modular design, therefore can freely make up according to actual needs, widened the application of robot control system.

Description of drawings:

Fig. 1 is the configuration connection layout of traditional industrial robot control system;

Fig. 2 is the configuration connection layout of this robot controlling platform;

Fig. 3 is the connection layout by two types of servo bags of Industrial Computer Control;

Fig. 4 is the structured flowchart of six axle servo control systems of robot among the embodiment;

Embodiment:

This control platform has been realized control to two kinds of servo bags by circuit as shown in Figure 3, the structured flowchart of the industrial robot control system that utilization the method is formed as shown in Figure 4, industrial computer can adopt ADVANTECH-610 among the figure, also can adopt YASKAWA MOTOMANSK10 robot body as controlling object, two kinds of servo bags adopt four YASKAWACACR-SR15SZ1SD-Y214 type single shafts to drive servo bag and four servo bags of driving of a DELTA TAU respectively, the Y214 type is the servo bag of voltage-controlled type, the S that is used for the drive machines people, L, four joints of U and R, DELTA TAU is the servo bag of PWM ripple control type, is used for B and two joints of T of drive machines people wrist.

Industrial computer produces control signal by PMAC, passes to four CACR-SR15SZ1SD-Y214 single shafts again after the amplification through two interface board ACC-8ED and drives servo bag, the servomotor in control S, L, U and four joints of R.And the drive signal of the servomotor of two other B and T passes to four servo bag DELTA TAU of driving by ACC-8F after being produced by PMAC.

The code-disc signal of the servomotor in S, L, U and four joints of R all is to be delivered to ACC-8D by servo bag earlier, is the absolute encoder conversion of signals increment code wheel signal, passes PMAC back by ACC-8E again; And the code-disc signal of the servomotor of B and T is directly to be sent to another piece ACC-8D, divide two-way to pass PMAC back again, can determine the joint angle and the motion state in 6 joints of SK10 robot by the program of on industrial computer, moving very accurately by ACC-8E and ACC-8F.

Software can utilize visualization procedure (as VC) establishment at present general WINTEL platform, the inverse kinematics algorithm that rudimentary algorithm adopts kinematics coordinate transform and Pieper to propose based on the D-H parameter, its structural parameters can be adjusted according to the different machines human body, reproduce with the two kinds of methods of directly programming by teaching the motion of robot is planned.Software also can be constructed under other operating systems (as UNIX, Linux etc.), and this wide-open hardware and software structure has a very important role for the dirigibility that improves robot manipulating task.

By control program, can control the motion of SK10 robot under joint coordinates, Cartesian coordinate, tool coordinates and User Defined coordinate, can finish the motion of straight line, circular arc and various SPL.This cover robot controlling platform not only can control robot be finished the various work that present general-purpose industrial robot is possessed, but also can further develop corresponding software on its basis, realizes new function.

The present invention has replaced computing machine special-purpose in conventional machines people's controller with general opened industrial computing machine, make not only control robot according to the conventional method of user, and can adjust and change the job task of robot neatly, even can on open computer platform, construct the new adaptation upper strata Control Software of different production requirements separately by computing machine.Therefore can improve the user to the ROBOT CONTROL ability easily for robot increases the function that does not possess when some dispatch from the factory.This creation improves its control accuracy for the function that increases industrial robot, expands the application of robot in commercial production and has important effect.

Claims (2)

1. An open industrial robot control platform composed of a general industrial computer, a controller, a converter, a servo package, and a servo motor, is characterized in that: the multi-axis controller C1 can be inserted into the ISA bus plug of the industrial computer. On the slot, the multi-axis controller C1 interface is connected to the signal matching converter C4, and the signal matching converter C4 is connected to the servo package S1 after amplification, and the servo package S1 is connected to the servo motor M1 to form a driving pulse; the servo motor M1 passes through the code disc The signal conversion unit E1 is connected to the servo package S1; the servo package S1 is connected to the absolute code disc converter C2 through the EO port; the absolute code disc converter C2 is also connected to the multi-axis controller C1, another absolute code disc converter C3, and the signal The matching converter C4 is connected; the absolute code disc converter C3 is connected to the interface board C5, the interface board C5 is connected to the servo package S2, the servo package S2 is connected to the servo motor M2, and the servo motor M2 is connected to the absolute code disc converter C3 through the code disc signal output unit E2 connection; the interface board C5 is also connected with the multi-axis controller C1. 2. The open industrial robot control platform according to claim, characterized in that: the industrial computer is connected with the multi-axis controller through the ISA bus with a slot, and the multi-axis controller is connected with a plurality of interface boards, and the interface boards are respectively It is correspondingly connected with the absolute code disc converter; each interface board can be connected with a pair of servo packages to realize the control of multiple servo packages by one controller; the servo package is also connected with the absolute code disc converter, and the servo package is connected with the servo motor , the servo motor can also be connected with the multi-axis controller after being connected with the absolute code disc converter.

Images