CN107065682B - A kind of implementation method of the open bottom position instruction interface of robot controller - Google Patents
A kind of implementation method of the open bottom position instruction interface of robot controller Download PDFInfo
- Publication number
- CN107065682B CN107065682B CN201710351017.5A CN201710351017A CN107065682B CN 107065682 B CN107065682 B CN 107065682B CN 201710351017 A CN201710351017 A CN 201710351017A CN 107065682 B CN107065682 B CN 107065682B
- Authority
- CN
- China
- Prior art keywords
- joint
- joint position
- module
- sequence
- internal bus
- Prior art date
- Legal status (The legal status 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 status listed.)
- Active
Links
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/04—Programme control other than numerical control, i.e. in sequence controllers or logic controllers
- G05B19/042—Programme control other than numerical control, i.e. in sequence controllers or logic controllers using digital processors
- G05B19/0423—Input/output
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/20—Pc systems
- G05B2219/25—Pc structure of the system
- G05B2219/25257—Microcontroller
Abstract
The invention discloses a kind of implementation methods of the open bottom position instruction interface of robot controller, including third party's task space trajectory to plan pose sequence node transmitting data file；Joint space trajectory planning joint position sequence node transmitting data file；Task space trajectory plans pose sequence node on-line normalization；Joint space trajectory planning joint position sequence node on-line normalization.Third party's position command of the present invention can be divided into from transmission mode it is online and offline, from instruction meaning from can be divided into task space pose instruction and joint space position command.The bottom position instruction interface of open architecture robot controller should all support these transmission modes and instruction meaning.
Description
Technical field
The invention belongs to industrial robot control technology fields, specifically relate to a kind of open bottom position of robot controller and refer to
Enable the implementation method of interface.
Background technique
Industrial robot is the jewel on manufacturing industry imperial crown, will be played an important role in the industrial revolution of new generation.For
It gains the initiative in the industrial revolution of new generation, China proposes power's strategy of " intelligence manufacture 2025 ", copes with industrial structure tune
The problems such as whole, high-quality manufacture and aging of population, is to manufacturing industry bring challenge.Especially in Guangdong Province, the Zhejiang Province etc. in China
Manufacturing industry developed regions are proposed " machine substitute human labor " plan one after another, realize manufacturing replacement upgrading, push manufacturing hair
Exhibition.Industrial Robot Technology faces unprecedented policy advantage and the market demand.However, China's Industrial Robot Market quilt
Several big giant's monopolizations such as KUKA, ABB, FANUC, cause the development of native country Robot industry to be had difficulty in taking a step.Also, robot building
Enterprise extremely closes for protection technique and market interest, industrial robot control system, not only increases enterprise development and answers
With cost, the development of Industrial Robot Technology is also limited.
For the open bottom position instruction interface of robot controller to special movement needs are realized, fusion third party is offline certainly
Dynamic programming technique carries out kinematics, trajectory planning algorithm performance comparison is of great significance.However, the machine being commercialized at present
People's control system is all made of the nonshared control unit of enclosed construction, is generally made using special purpose computer as upper layer main control computer
It uses special purpose robot's language as off-line programing tool, is solidificated in EEPROM using special microprocessor, and by control algolithm.
This dedicated system it is difficult to ensure that third-party platform provide position command support.The Rapid Control Prototype Development of Dual such as DSPACE
System, although providing general hardware platform, software still needs to set up from bottom, and time cost cost is high.So
A kind of open robot controller is needed to be capable of providing the support to bottom position instruction.
Summary of the invention
In order to overcome the problems, such as the bottom position instruction interface closing of robot nonshared control unit, the invention proposes one kind
The implementation method of the open bottom position instruction interface of robot controller.Third party's position command can divide from transmission mode
To be online and offline, the instruction of task space pose and joint space position command can be divided into from instruction meaning.It is open
The bottom position instruction interface of robot controller should all support these transmission modes and instruction meaning.
In order to achieve the above objectives, the implementation method of the open bottom position instruction interface of robot controller of the present invention
It mainly comprises the steps that
Third party's task space trajectory plans pose sequence node transmitting data file.
In the pose sequence node write-in memory module RAM/ROM that third-party platform plans task space trajectory, FPGA
In memory interface module the task space pose sequence node in RAM/ROM is read under the action of control bus A
In cache module Block RAM.Control parameter is arranged in host CPU, will be stored in Block RAM by FPGA internal bus A
In pose sequence node read in host CPU inverse kinematics device and carry out inverse kinematics, pose sequence node is turned
Change joint rotation angle sequence into, joint rotation angle sequence is converted into driving joint by the joint space trajectory planning of trajectory planning module
The joint position sequence of rotation, and send the motion control that position control module realizes each joint to.Host CPU passes through FPGA simultaneously
Internal bus A by joint position sequence be written joint position control instruction module, auxiliary CPU can by internal bus B from joint position
It sets and reads current joint position control instruction in control instruction module.
Third party's joint space trajectory planning joint position sequence node transmitting data file.
The discrete joint position sequence of joint space trajectory planning is written in memory module RAM/ROM third-party platform,
Control parameter, the discrete joint position sequence that will be stored in RAM/ROM by the memory interface module in FPGA is arranged in host CPU
Column are read in cache module Block RAM, and host CPU is read in cache module BlockRAM by internal bus A
Discrete joint position sequence, and send the motion control that position control module realizes each joint to.Host CPU passes through FPGA simultaneously
Internal bus A by joint position sequence be written joint position control instruction module, auxiliary CPU can by internal bus B from joint position
It sets and reads current joint position control instruction in control instruction module.
Third party's task space trajectory plans pose sequence node on-line normalization.
Pose sequence node that task space trajectory is planned is entered the cache of FPGA by third-party platform by auxiliary CPU write
In module Block RAM, control parameter is arranged in host CPU, will be stored in the pose in Block RAM by FPGA internal bus A
Sequence node reads in host CPU inverse kinematics device and carries out inverse kinematics, and pose sequence node is converted into joint
Corner sequence, joint rotation angle sequence are converted into the pass of driving articulation by the joint space trajectory planning of trajectory planning module
Position sequence is saved, and sends the motion control that position control module realizes each joint to.Host CPU passes through FPGA internal bus simultaneously
Joint position control instruction module is written in joint position sequence by A, and auxiliary CPU can be referred to by internal bus B from joint position control
It enables and reads current joint position control instruction in module.
Third party's joint space trajectory planning joint position sequence node on-line normalization.
The joint position sequence node of joint space trajectory planning is entered the high speed of FPGA by third-party platform by auxiliary CPU write
In cache module Block RAM, host CPU reads the joint position section in cache module Block RAM by internal bus A
Point sequence, and send the motion control that position control module realizes each joint to.Host CPU will by FPGA internal bus A simultaneously
Joint position control instruction module is written in joint position sequence, and auxiliary CPU can be by internal bus B from joint position control instruction mould
Current joint position control instruction is read in block.
The invention has the following advantages:
Third party's task space trajectory plans pose sequence node transmitting data file and third party's joint space track rule
It draws joint position sequence node transmitting data file and uses file, transfer data to control system memory,
Advantage is that its control process can be defined as to a kind of specific operation functional module, is arbitrarily called by host CPU, opens for product
Hair realizes peculair motion demand；Third party's task space trajectory plans that pose sequence node on-line normalization mode and third party are closed
Section space tracking planning joint position sequence node on-line normalization mode contacts receiving locus data using auxiliary CPU to realize machine
The motion control of people, is mainly used for research work, and different motion model, the comparative study for moving derivation algorithm may be implemented,
It is convenient and efficient.
Detailed description of the invention
Fig. 1 is that bottom position instructs open interface control principle drawing.
Specific embodiment
The invention will be described in further detail with reference to the accompanying drawing:
The open implementation method of robot controller bottom position instruction interface of the present invention mainly includes following step
It is rapid:
Third party's task space trajectory plans pose sequence node transmitting data file.
This mode is mainly used in the transmission of third party's task space trajectory planning off-line data, and third-party platform will
In the pose sequence node write-in memory module RAM/ROM of task space trajectory planning, the memory interface module in FPGA exists
The task space pose sequence node in RAM/ROM is read into cache module Block RAM under the action of control bus A
In.Control parameter is arranged in host CPU, is read the pose sequence node being stored in Block RAM by FPGA internal bus A
Inverse kinematics are carried out in host CPU inverse kinematics device, pose sequence node are converted into joint rotation angle sequence, joint turns
Angle sequence is converted into the joint position sequence of driving articulation by the joint space trajectory planning of trajectory planning module, and passes
Give the motion control that position control module realizes each joint.Host CPU passes through FPGA internal bus A for joint position sequence simultaneously
Joint position control instruction module is written, auxiliary CPU can be read from joint position control instruction module by internal bus B to be worked as
Preceding joint position control instruction.
Third party's joint space trajectory planning joint position sequence node transmitting data file.
This mode is mainly used in the transmission of third party's joint space trajectory planning off-line data.Third-party platform will
In the discrete joint position sequence write-in memory module RAM/ROM of joint space trajectory planning, control parameter is arranged in host CPU, leads to
The memory interface module crossed in FPGA is by the discrete joint position sequence read being stored in RAM/ROM to cache module
In Block RAM, host CPU reads the discrete joint position sequence in cache module Block RAM by internal bus A,
And send the motion control that position control module realizes each joint to.Host CPU passes through FPGA internal bus A for joint position simultaneously
Joint position control instruction module is written in sequence, and auxiliary CPU can be read from joint position control instruction module by internal bus B
To current joint position control instruction.
Third party's task space trajectory plans pose sequence node on-line normalization.
This mode is mainly used in the transmission of third party's task space trajectory planning online data.Third-party platform will
The pose sequence node of task space trajectory planning is entered in the cache module Block RAM of FPGA by auxiliary CPU write, main
Control parameter is arranged in CPU, and the pose sequence node being stored in Block RAM is read host CPU by FPGA internal bus A
Inverse kinematics are carried out in inverse kinematics device, and pose sequence node is converted into joint rotation angle sequence, joint rotation angle sequence
Column are converted into the joint position sequence of driving articulation by the joint space trajectory planning of trajectory planning module, and send to
Position control module realizes the motion control in each joint.Joint position sequence is written by FPGA internal bus A for host CPU simultaneously
Joint position control instruction module, auxiliary CPU can be read from joint position control instruction module current by internal bus B
Joint position control instruction.
Third party's joint space trajectory planning joint position sequence node on-line normalization.
This mode is mainly used in the transmission of third party's joint space trajectory planning online data.Third-party platform will
The joint position sequence node of joint space trajectory planning is entered in the cache module Block RAM of FPGA by auxiliary CPU write,
Host CPU reads the joint position sequence node in cache module Block RAM by internal bus A, and sends position to
Control module realizes the motion control in each joint.By FPGA internal bus A joint is written in joint position sequence by host CPU simultaneously
Position control instruction module, auxiliary CPU can read current joint from joint position control instruction module by internal bus B
Position control instruction.
Embodiment one
With reference to Fig. 1, it is illustrated so that third party's task space trajectory plans pose sequence node transmitting data file as an example.
After carrying out task space trajectory planning in third-party platform, pose sequence node data file is saved as to the text of .bin format
Part is specified track data file download in memory paragraph to the track data in RAM/ROM block by network interface.Host CPU is by setting
The register corresponding positions for setting dma controller are 1, keep dma controller enabled.Dma controller is specified from being stored in RAM/ROM block
Pose sequence node data are read at storage location into cache Block RAM, host CPU passes through internal bus controller A
The pose sequence node in cache Block RAM is read, and is sent to host CPU Inverse Kinematics Solution module, by each of solution
Joint rotation angle sequence is sent to position control module, and position control module realizes that joint trajectories track by PD control.It is main simultaneously
By FPGA internal bus A joint position control instruction module is written in joint position sequence by CPU, and auxiliary CPU can be by internal total
Line B reads current joint position control instruction from joint position control instruction module.
Embodiment two
With reference to Fig. 1, carried out in third party's joint space trajectory planning joint position sequence node on-line normalization mode as an example
Explanation.Third-party platform by the joint position sequence node of joint space trajectory planning by Ethernet interface and udp protocol with
Hexadecimal format is sent to auxiliary CPU, communication speed 1kHz online.Auxiliary CPU receives a frame data and is just written into height
In fast cache module Block RAM, initial address 0x0000.Host CPU reads cache module by internal bus A
Joint position sequence node in Block RAM, and send position control module to, position control module is realized by PD control
Joint trajectories tracking.By FPGA internal bus A joint position control instruction mould is written in joint position sequence by host CPU simultaneously
Block, auxiliary CPU can read current joint position control instruction by internal bus B from joint position control instruction module.
Claims (1)
1. a kind of implementation method of the open bottom position instruction interface of robot controller, which comprises the following steps:
1) third party's task space trajectory plans pose sequence node transmitting data file；Third-party platform is by task space trajectory
The pose sequence node of planning is written in memory module RAM/ROM, work of the memory interface module in FPGA in control bus A
It is read in cache module Block RAM with the lower task space pose sequence node by RAM/ROM, host CPU setting
The pose sequence node being stored in Block RAM is read the inverse movement of host CPU by FPGA internal bus A by control parameter
It learns in solver and carries out inverse kinematics, pose sequence node is converted into joint rotation angle sequence, joint rotation angle sequence passes through
The joint space trajectory planning of trajectory planning module is converted into the joint position sequence of driving articulation, and sends position control to
Molding block realizes the motion control in each joint, while by FPGA internal bus A joint position is written in joint position sequence by host CPU
Control instruction module is set, auxiliary CPU can read current joint position by internal bus B from joint position control instruction module
Set control instruction；
2) third party's joint space trajectory planning joint position sequence node transmitting data file；Third-party platform is by joint space
In the discrete joint position sequence write-in memory module RAM/ROM of trajectory planning, control parameter is arranged in host CPU, by FPGA
Memory interface module by the discrete joint position sequence read being stored in RAM/ROM to cache module Block
In RAM, host CPU reads the discrete joint position sequence in cache module Block RAM by internal bus A, and transmits
The motion control in each joint is realized to position control module, while host CPU is write joint position sequence by FPGA internal bus A
Enter joint position control instruction module, auxiliary CPU can be read from joint position control instruction module currently by internal bus B
Joint position control instruction；
3) third party's task space trajectory plans pose sequence node on-line normalization；Third-party platform plans task space trajectory
Pose sequence node entered in the cache module Block RAM of FPGA by auxiliary CPU write, host CPU be arranged control parameter, lead to
Cross FPGA internal bus A by the pose sequence node being stored in Block RAM read in host CPU inverse kinematics device into
Pose sequence node is converted into joint rotation angle sequence by row inverse kinematics, and joint rotation angle sequence passes through trajectory planning module
Joint space trajectory planning be converted into the joint position sequence of driving articulation, and send to position control module realize it is each
The motion control in joint, while by FPGA internal bus A joint position control instruction mould is written in joint position sequence by host CPU
Block, auxiliary CPU can read current joint position control instruction by internal bus B from joint position control instruction module；
4) third party's joint space trajectory planning joint position sequence node on-line normalization；Third-party platform is by joint space track
The joint position sequence node of planning is entered in the cache module Block RAM of FPGA by auxiliary CPU write, and host CPU passes through interior
Portion bus A reads the joint position sequence node in cache module Block RAM, and sends position control module realization to
The motion control in each joint, while by FPGA internal bus A joint position control instruction is written in joint position sequence by host CPU
Module, auxiliary CPU can be read current joint position control from joint position control instruction module by internal bus B and referred to
It enables.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201710351017.5A CN107065682B (en) | 2017-05-17 | 2017-05-17 | A kind of implementation method of the open bottom position instruction interface of robot controller |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201710351017.5A CN107065682B (en) | 2017-05-17 | 2017-05-17 | A kind of implementation method of the open bottom position instruction interface of robot controller |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN107065682A CN107065682A (en) | 2017-08-18 |
| CN107065682B true CN107065682B (en) | 2019-06-11 |
Family
ID=59609698
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201710351017.5A Active CN107065682B (en) | 2017-05-17 | 2017-05-17 | A kind of implementation method of the open bottom position instruction interface of robot controller |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN107065682B (en) |
Family Cites Families (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US4868472A (en) * | 1986-11-20 | 1989-09-19 | Unimation Inc. | Communication interface for multi-microprocessor servo control in a multi-axis robot control system |
| CN1095420C (en) * | 2000-09-30 | 2002-12-04 | 中国科学院自动化研究所 | Opened industrial robot controlling platform |
| JP2002113675A (en) * | 2000-10-11 | 2002-04-16 | Sony Corp | Robot control system and introducing method for robot controlling software |
| CN100401218C (en) * | 2005-12-13 | 2008-07-09 | 天津大学 | Parallel connection equipment opening type motion control card based on two-stage DSP and control method thereof |
| CN103823467A (en) * | 2012-05-23 | 2014-05-28 | 浙江大学 | Control method of industrial robot demonstration planner with motion planning function |
-
2017
- 2017-05-17 CN CN201710351017.5A patent/CN107065682B/en active Active
Also Published As
| Publication number | Publication date |
|---|---|
| CN107065682A (en) | 2017-08-18 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN107363812A (en) | The sixdegree-of-freedom simulation teaching system of controlled in wireless | |
| CN104965517B (en) | A kind of planing method of robot cartesian space track | |
| CN105479468B (en) | A kind of tele-robotic motion controller | |
| CN104786221B (en) | A kind of open method for controlling robot based on Ethernet | |
| CN100401218C (en) | Parallel connection equipment opening type motion control card based on two-stage DSP and control method thereof | |
| CN104423318B (en) | Operating machine with redundant axes and resolution of the redundancy in real time | |
| DE102012218297A1 (en) | Method for dynamically optimizing a robot control interface | |
| CN107838922B (en) | Robot repetition-free teaching method | |
| CN108279674B (en) | Intelligent moving method, device, robot and storage medium | |
| CN104615087A (en) | Bus type motion controller | |
| US9342068B2 (en) | Motion controller and motor control system | |
| CN102941426B (en) | Intelligent deflection system matched with robot | |
| CN103386685A (en) | Robot programming control method | |
| CN107544299B (en) | PC (personal computer) end APP (application) system for teaching control of six-degree-of-freedom mechanical arm | |
| CN108628188A (en) | Control system, controller and control method | |
| US20180264651A1 (en) | Controller, control system, and control method | |
| CN105702112A (en) | Teaching type numerical control machine tool system and application thereof | |
| CN113836702A (en) | Robot teaching programming method and robot teaching programming device | |
| CN107065682B (en) | A kind of implementation method of the open bottom position instruction interface of robot controller | |
| CN110967042A (en) | Industrial robot positioning precision calibration method, device and system | |
| CN108500967A (en) | Control method, modular articulated robot and storage medium | |
| CN106338966A (en) | Novel programming method for trajectory planning of industrial robot | |
| CN103552072B (en) | A kind of robot control method based on embedded controller and device | |
| CN204271965U (en) | A kind of step actuator | |
| CN114800505A (en) | Robot operation control method and device |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant | ||
| TR01 | Transfer of patent right |
Effective date of registration: 20210506 Address after: No.28, Xianning West Road, Beilin District, Xi'an, Shaanxi 710000 Patentee after: Zhao Fei Address before: Beilin District Xianning West Road 710049, Shaanxi city of Xi'an province No. 28 Patentee before: XI'AN JIAOTONG University |
|
| TR01 | Transfer of patent right | ||
| TR01 | Transfer of patent right |
Effective date of registration: 20210607 Address after: Room 1807, building 3, 311 Yanxin Road, Huishan Economic Development Zone, Wuxi City, Jiangsu Province, 214000 Patentee after: Wuxi Chaotong Intelligent Manufacturing Technology Research Institute Co.,Ltd. Address before: No.28, Xianning West Road, Beilin District, Xi'an, Shaanxi 710000 Patentee before: Zhao Fei |
|
| TR01 | Transfer of patent right |