CN109254567A - A kind of multi-axis industrial robot's control system based on FPGA - Google Patents
A kind of multi-axis industrial robot's control system based on FPGA Download PDFInfo
- Publication number
- CN109254567A CN109254567A CN201810755005.3A CN201810755005A CN109254567A CN 109254567 A CN109254567 A CN 109254567A CN 201810755005 A CN201810755005 A CN 201810755005A CN 109254567 A CN109254567 A CN 109254567A
- Authority
- CN
- China
- Prior art keywords
- unit
- input terminal
- output end
- control unit
- connect
- 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.)
- Pending
Links
- 230000009466 transformation Effects 0.000 claims description 9
- 230000000007 visual effect Effects 0.000 claims description 6
- 238000005070 sampling Methods 0.000 claims description 3
- 238000010586 diagram Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 2
- 238000002955 isolation Methods 0.000 description 2
- 230000006978 adaptation Effects 0.000 description 1
- 230000003044 adaptive effect Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 239000008358 core component Substances 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000000034 method Methods 0.000 description 1
- 230000001360 synchronised effect Effects 0.000 description 1
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/418—Total factory control, i.e. centrally controlling a plurality of machines, e.g. direct or distributed numerical control [DNC], flexible manufacturing systems [FMS], integrated manufacturing systems [IMS] or computer integrated manufacturing [CIM]
- G05B19/41845—Total factory control, i.e. centrally controlling a plurality of machines, e.g. direct or distributed numerical control [DNC], flexible manufacturing systems [FMS], integrated manufacturing systems [IMS] or computer integrated manufacturing [CIM] characterised by system universality, reconfigurability, modularity
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P80/00—Climate change mitigation technologies for sector-wide applications
- Y02P80/40—Minimising material used in manufacturing processes
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Engineering & Computer Science (AREA)
- General Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Quality & Reliability (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
Abstract
Multi-axis industrial robot's control system based on FPGA that the present invention provides a kind of, including track acquiring unit, motion control unit, encoder feedback unit, the first vector control unit U1 are to the 6th vector control unit U6 and the first PWM output unit W1 to the 6th PWM output unit W6.The present invention is by the two of industrial robot big electric-control systems, servo drive system and tracking control system are combined into one, and have maximally utilized spatial volume, and a fpga core unit integrates the control logic of multiple PMSM, and complete the trajectory planning of multiaxis in real time simultaneously, save resource and cost;Using FPGA as main control chip, fast response time, and the mode of FPGA finite state machine, the error message and grave warning of servo-system more can be flexibly handled.This multi-axis industrial robot's control system has preferable real value and open application prospect.
Description
Technical field
The present invention relates to industrial robot field, especially a kind of multi-axis industrial robot's control system based on FPGA.
Background technique
Robot industry is included in one of ten big emphasis promotion industries by " industry manufacture 2025 ".21 century enters comprehensively
Important epoch of industrial robot development, with the development that the shortage and science and technology of labour is advanced by leaps and bounds, industrial machine
People will gradually replace manual labor heavy in factory;
Industrial robot control system and servo-system are collectively as one of big core component of industrial robot three, entire
It is played a crucial role in industrial robot system;The most servo-driver of existing industrial robot control system and rail
The discrete assembling of mark controller hardware, and the uniaxial independent driving in servo-system, one servo-driver of each axis needs, one
A typical six-DOF robot control system wants six servo-drivers of different sizes and a tracking controller assembling
It forms, the consequence done so is that industrial robot not only increases cost and increases volume, huge and heavy inconvenient mobile
Seriously constrain the adaptive capacity to environment of industrial robot.More importantly existing industrial robot servo-system and control
For systems most using DSP as arithmetic core, this mode seriously constrains the real-time of multiaxis collaborative work, it is therefore necessary to
A kind of servo-drive and trajectory planning hardware integration are developed and design, volume is smaller, and specific power density is higher, and multiaxis is same
When concurrent working industrial robot servo-system.
Summary of the invention
For above-mentioned the above deficiencies in the existing technologies, the present invention provides a kind of multi-axial industrial machine based on FPGA
Device people's control system.
In order to solve the above-mentioned technical problem, present invention employs following technical solutions:
A kind of multi-axis industrial robot's control system based on FPGA, including track acquiring unit, motion control unit, coding
Device feedback unit, the first vector control unit U1 to the 6th vector control unit U6, the first PWM output unit W1 to the 6th PWM
Output unit W6;
The output end of the track acquiring unit and an input terminal of motion control unit connect, encoder feedback list
Member output end, visual feedback output end and motion control unit another input terminal connect, motion control unit it is defeated
Outlet is connect with the input terminal of input terminal to the 6th vector control unit U6 of the first vector control unit U1, the first vector controlled
The output end of unit U1 to the 6th vector control unit U6 output end respectively with the input terminal of the first PWM output unit W1 to
The access port of six PWM output unit W6 connects;
The motion control unit includes trajectory planning unit, track correct unit, error protection unit, spacing interpolation
Unit, RMAC motion planning unit and electronic gear output unit;
The output end of track correct unit is connect with an input terminal of trajectory planning unit, the output of error protection unit
End is connect with another input terminal of trajectory planning unit, the output end of trajectory planning unit and the input terminal of spacing interpolation unit
Connection, the output end of spacing interpolation unit connect with the input terminal of RMAC motion planning unit, RMAC motion planning unit it is defeated
Outlet is connect with the input terminal of electronic gear output unit, the output of the input terminal and visual feedback unit of track correct unit
The output end connection at end, encoder feedback, the input terminal of trajectory planning unit are connect with the output end of track acquiring unit, electronics
The input terminal of the output end of gear output unit and the first vector control unit U1 to the 6th vector control unit U6 input terminal
Connection;
The first vector control unit U1 is identical to the 6th vector control unit U6 structure, each vector controlled
Unit includes electronic gear input unit, coordinate transformation unit, encoder input unit, current sampling unit, SVPWM generator
Unit;
The input terminal of electronic gear access unit is connect with the electronic gear output end of fortune function control unit, and electronic gear is defeated
One input terminal of the output end and coordinate transformation unit that enter unit connects, output end, the current sample of encoder input unit
The output end of unit and another input terminal of coordinate transform connect, the output end and SVPWM generator list of coordinate transformation unit
The input terminal connection of member, the output end of SVPWM generating unit are connect with the input terminal of PWM output unit.
The present invention by adopting the above technical scheme possessed by beneficial effect be: by the two of industrial robot big electric-control systems:
Servo drive system and tracking control system are combined into one, and 3 D stereo board mounting structure has maximally utilized spatial volume,
One fpga core unit integrates the control logic of multiple PMSM, and completes the trajectory planning of multiaxis in real time simultaneously, has saved money
Source and cost;High-voltage power power supply and low-voltage control power isolation, control signal and power signal isolation, ensure that servo-system
Safe and stable operation;Using FPGA as main control chip, fast response time, the synchronous Du Genggao of each axis, and FPGA finite state machine
Mode, more can flexibly handle the error message and grave warning of servo-system;Modular hardware configuration, so that adaptation is different
Driver Card need to be only replaced when the motor of power in power capacity allowed band, does not need replacement master control
Part and other interface modules, thus be more flexible;With preferable real value and open application prospect.
Detailed description of the invention
Fig. 1 is multi-axis industrial robot's control structure schematic diagram based on FPGA;
Fig. 2 is the structural schematic diagram of motion control unit of the invention;
Fig. 3 is the structural schematic diagram of vector control unit of the invention.
Specific embodiment
Present invention will be further explained below with reference to the attached drawings and specific embodiments.
As shown in Figure 1, a kind of multi-axis industrial robot based on FPGA controls system, including track acquiring unit, movement control
Unit processed, encoder feedback unit, the first vector control unit U1 to the 6th vector control unit U6, the first PWM output unit
W1 to the 6th PWM output unit W6;
The output end of the track acquiring unit and an input terminal of motion control unit connect, encoder feedback list
Member output end, visual feedback output end and motion control unit another input terminal connect, motion control unit it is defeated
Outlet is connect with the input terminal of input terminal to the 6th vector control unit U6 of the first vector control unit U1, the first vector controlled
The output end of unit U1 to the 6th vector control unit U6 output end respectively with the input terminal of the first PWM output unit W1 to
The access port of six PWM output unit W6 connects;
As shown in Fig. 2, the motion control unit includes trajectory planning unit, track correct unit, error protection list
Member, spacing interpolation unit, RMAC motion planning unit and electronic gear output unit;
The output end of track correct unit is connect with an input terminal of trajectory planning unit, the output of error protection unit
End is connect with another input terminal of trajectory planning unit, the output end of trajectory planning unit and the input terminal of spacing interpolation unit
Connection, the output end of spacing interpolation unit connect with the input terminal of RMAC motion planning unit, RMAC motion planning unit it is defeated
Outlet is connect with the input terminal of electronic gear output unit, the output of the input terminal and visual feedback unit of track correct unit
The output end connection at end, encoder feedback, the input terminal of trajectory planning unit are connect with the output end of track acquiring unit, electronics
The input terminal of the output end of gear output unit and the first vector control unit U1 to the 6th vector control unit U6 input terminal
Connection;
As shown in figure 3, the first vector control unit U1 is identical to the 6th vector control unit U6 structure, often
A vector control unit includes electronic gear input unit, coordinate transformation unit, encoder input unit, current sampling unit,
SVPWM generator unit;
The input terminal of electronic gear access unit is connect with the electronic gear output end of fortune function control unit, and electronic gear is defeated
One input terminal of the output end and coordinate transformation unit that enter unit connects, output end, the current sample of encoder input unit
The output end of unit and another input terminal of coordinate transform connect, the output end and SVPWM generator list of coordinate transformation unit
The input terminal connection of member, the output end of SVPWM generating unit are connect with the input terminal of PWM output unit.
Claims (1)
1. a kind of multi-axis industrial robot based on FPGA controls system, it is characterised in that: including track acquiring unit, motion control
Unit, encoder feedback unit, the first vector control unit U1 to the 6th vector control unit U6, the first PWM output unit W1
To the 6th PWM output unit W6;
The output end of the track acquiring unit and an input terminal of motion control unit connect, encoder feedback unit
Another input terminal of output end, the output end of visual feedback and motion control unit connects, the output end of motion control unit
It is connect with the input terminal of input terminal to the 6th vector control unit U6 of the first vector control unit U1, the first vector control unit
The output end of U1 to the 6th vector control unit U6 output end respectively with the input terminal of the first PWM output unit W1 to the 6th
The access port of PWM output unit W6 connects;
The motion control unit includes trajectory planning unit, track correct unit, error protection unit, spacing interpolation list
Member, RMAC motion planning unit and electronic gear output unit;
The output end of track correct unit is connect with an input terminal of trajectory planning unit, the output end of error protection unit with
Another input terminal of trajectory planning unit connects, and the output end of trajectory planning unit and the input terminal of spacing interpolation unit connect
It connects, the output end of spacing interpolation unit is connect with the input terminal of RMAC motion planning unit, the output of RMAC motion planning unit
End is connect with the input terminal of electronic gear output unit, the output end of the input terminal of track correct unit and visual feedback unit,
The output end of encoder feedback connects, and the input terminal of trajectory planning unit is connect with the output end of track acquiring unit, electronics tooth
The input terminal for taking turns the output end of output unit and input terminal to the 6th vector control unit U6 of the first vector control unit U1 connects
It connects;
The vector control unit includes electronic gear input unit, coordinate transformation unit, encoder input unit, and electric current is adopted
Sample unit, SVPWM generator unit;
The input terminal of electronic gear access unit is connect with the electronic gear output end of fortune function control unit, and electronic gear input is single
The output end of member and an input terminal of coordinate transformation unit connect, output end, the current sampling unit of encoder input unit
Output end and another input terminal of coordinate transform connect, the output end of coordinate transformation unit and SVPWM generator unit
Input terminal connection, the output end of SVPWM generating unit are connect with the input terminal of PWM output unit.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810755005.3A CN109254567A (en) | 2018-07-11 | 2018-07-11 | A kind of multi-axis industrial robot's control system based on FPGA |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810755005.3A CN109254567A (en) | 2018-07-11 | 2018-07-11 | A kind of multi-axis industrial robot's control system based on FPGA |
Publications (1)
Publication Number | Publication Date |
---|---|
CN109254567A true CN109254567A (en) | 2019-01-22 |
Family
ID=65051685
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810755005.3A Pending CN109254567A (en) | 2018-07-11 | 2018-07-11 | A kind of multi-axis industrial robot's control system based on FPGA |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109254567A (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110768606A (en) * | 2019-11-12 | 2020-02-07 | 佛山智能装备技术研究院 | Hardware modularization control drives integrative device |
Citations (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN201163363Y (en) * | 2007-11-30 | 2008-12-10 | 上海奈凯电子科技有限公司 | General multi-axis motion control system on numerical control machine |
CN201426109Y (en) * | 2009-05-31 | 2010-03-17 | 深圳市雷泰控制技术有限公司 | PCI bus bar type multi-shaft impulse type movement control card |
CN201749341U (en) * | 2010-06-24 | 2011-02-16 | 深圳市雷泰控制技术有限公司 | Trajectory control card |
CN201804248U (en) * | 2010-06-25 | 2011-04-20 | 周孟婵 | Motion control card |
CN102291073A (en) * | 2011-08-04 | 2011-12-21 | 广西民族师范学院 | Multi-axis stepper motor interpolation controller and multi-axis stepper motor motion control card |
CN102722141A (en) * | 2012-06-28 | 2012-10-10 | 华南理工大学 | Non-uniform rational B-spline (NURBS) curve real-time interpolation method based on personal computer (PC)-field programmable gate array (FPGA) |
CN102811012A (en) * | 2012-07-20 | 2012-12-05 | 华中科技大学 | Field programmable gate array-based (FPGA-based) multi-axis servo motor current loop control system and control method |
CN202878317U (en) * | 2012-09-29 | 2013-04-17 | 上海交通大学 | Multi-freedom-degree industrial robot motion controller |
CN203266646U (en) * | 2013-06-05 | 2013-11-06 | 山东省科学院自动化研究所 | Heavy-duty articulated robot control system with four degrees of freedom |
CN103592892A (en) * | 2013-10-12 | 2014-02-19 | 欣旺达电子股份有限公司 | Method and system for controlling multi-axis motion |
CN103941648A (en) * | 2014-03-07 | 2014-07-23 | 东莞市升力智能科技有限公司 | Multi-axis motion control system and control method thereof |
CN204308953U (en) * | 2014-11-20 | 2015-05-06 | 西安电子科技大学 | A kind of special motion controller hardware platform for six-degree-of-freedom parallel robot |
CN105643399A (en) * | 2015-12-29 | 2016-06-08 | 沈阳理工大学 | Automatic lapping and polishing system for complex surface of compliant control-based robot and machining method |
CN206224181U (en) * | 2016-11-10 | 2017-06-06 | 华南理工大学 | A kind of multiple-axis servo drive system position feedback data interface card based on FPGA |
CN107370431A (en) * | 2017-08-02 | 2017-11-21 | 杭州电子科技大学 | A kind of industrial robot obscures Auto-disturbance-rejection Control with permagnetic synchronous motor |
CN107505882A (en) * | 2017-10-25 | 2017-12-22 | 卢俊 | A kind of multi-axis motion controller and control method |
CN107908191A (en) * | 2017-12-20 | 2018-04-13 | 芜湖哈特机器人产业技术研究院有限公司 | The kinetic control system and method for a kind of series-parallel robot |
-
2018
- 2018-07-11 CN CN201810755005.3A patent/CN109254567A/en active Pending
Patent Citations (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN201163363Y (en) * | 2007-11-30 | 2008-12-10 | 上海奈凯电子科技有限公司 | General multi-axis motion control system on numerical control machine |
CN201426109Y (en) * | 2009-05-31 | 2010-03-17 | 深圳市雷泰控制技术有限公司 | PCI bus bar type multi-shaft impulse type movement control card |
CN201749341U (en) * | 2010-06-24 | 2011-02-16 | 深圳市雷泰控制技术有限公司 | Trajectory control card |
CN201804248U (en) * | 2010-06-25 | 2011-04-20 | 周孟婵 | Motion control card |
CN102291073A (en) * | 2011-08-04 | 2011-12-21 | 广西民族师范学院 | Multi-axis stepper motor interpolation controller and multi-axis stepper motor motion control card |
CN102722141A (en) * | 2012-06-28 | 2012-10-10 | 华南理工大学 | Non-uniform rational B-spline (NURBS) curve real-time interpolation method based on personal computer (PC)-field programmable gate array (FPGA) |
CN102811012A (en) * | 2012-07-20 | 2012-12-05 | 华中科技大学 | Field programmable gate array-based (FPGA-based) multi-axis servo motor current loop control system and control method |
CN202878317U (en) * | 2012-09-29 | 2013-04-17 | 上海交通大学 | Multi-freedom-degree industrial robot motion controller |
CN203266646U (en) * | 2013-06-05 | 2013-11-06 | 山东省科学院自动化研究所 | Heavy-duty articulated robot control system with four degrees of freedom |
CN103592892A (en) * | 2013-10-12 | 2014-02-19 | 欣旺达电子股份有限公司 | Method and system for controlling multi-axis motion |
CN103941648A (en) * | 2014-03-07 | 2014-07-23 | 东莞市升力智能科技有限公司 | Multi-axis motion control system and control method thereof |
CN204308953U (en) * | 2014-11-20 | 2015-05-06 | 西安电子科技大学 | A kind of special motion controller hardware platform for six-degree-of-freedom parallel robot |
CN105643399A (en) * | 2015-12-29 | 2016-06-08 | 沈阳理工大学 | Automatic lapping and polishing system for complex surface of compliant control-based robot and machining method |
CN206224181U (en) * | 2016-11-10 | 2017-06-06 | 华南理工大学 | A kind of multiple-axis servo drive system position feedback data interface card based on FPGA |
CN107370431A (en) * | 2017-08-02 | 2017-11-21 | 杭州电子科技大学 | A kind of industrial robot obscures Auto-disturbance-rejection Control with permagnetic synchronous motor |
CN107505882A (en) * | 2017-10-25 | 2017-12-22 | 卢俊 | A kind of multi-axis motion controller and control method |
CN107908191A (en) * | 2017-12-20 | 2018-04-13 | 芜湖哈特机器人产业技术研究院有限公司 | The kinetic control system and method for a kind of series-parallel robot |
Non-Patent Citations (2)
Title |
---|
刘雷: "基于FPGA的六轴工业机器人伺服系统设计与实现" * |
李钟: "基于DSP+ARM的工业机器人控制系统设计与实现" * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110768606A (en) * | 2019-11-12 | 2020-02-07 | 佛山智能装备技术研究院 | Hardware modularization control drives integrative device |
CN110768606B (en) * | 2019-11-12 | 2022-04-01 | 佛山智能装备技术研究院 | Hardware modularization control drives integrative device |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN203449306U (en) | Master-slave-type double-industrial-robot coordination operation control system | |
CN201689302U (en) | Integrated intelligent servo driver | |
CN104391477A (en) | Drive-control integrated networked intelligent controller | |
CN105881504B (en) | Delta robot control system with traction visual teaching function | |
CN103522290A (en) | Distributed robot control system based on field buses | |
CN105033996A (en) | Control system based on hand-push teaching type five-shaft horizontal joint robot | |
CN110579980A (en) | Universal type servo control algorithm validity verification device | |
CN203250190U (en) | Controller of industrial robot | |
CN102841561B (en) | Diaxon high speed adhesive dispensing robot servo-control system | |
CN109254567A (en) | A kind of multi-axis industrial robot's control system based on FPGA | |
CN105406710A (en) | Integrated servo drive system of multi-axis mobile robot | |
CN203459804U (en) | Digital control system of plasma cutting machine | |
CN111816039A (en) | Electromechanical transmission control system and control method | |
CN202572010U (en) | Control system for spindle of three-dimensional numerical control machine tool | |
CN103978324A (en) | Double-core five-shaft welding robot control system | |
CN107662210A (en) | A kind of resistance to irradiation dynamic power machine hand control system | |
CN207924430U (en) | a kind of robot controller | |
CN105302031A (en) | Control device and control method for piling carrying robot | |
CN206544182U (en) | A kind of robot control system | |
CN203094429U (en) | Steering engine controller | |
CN105373109B (en) | A kind of Delta robots control system | |
CN103433607A (en) | Digitalized plasma cutting machine control system | |
CN114505853B (en) | Remote layered control method and system for industrial robot | |
CN208557513U (en) | Multi-axis industrial robot's servo-system | |
CN216286301U (en) | AGV remote control device realized by using multiple communication modes of upper computer |
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 | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20190122 |