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 PDF

Info

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
Application number
CN201810755005.3A
Other languages
Chinese (zh)
Inventor
高明煜
何佳欢
詹志平
黄继业
傅煌培
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Hangzhou Dianzi University
Original Assignee
Hangzhou Dianzi University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Hangzhou Dianzi University filed Critical Hangzhou Dianzi University
Priority to CN201810755005.3A priority Critical patent/CN109254567A/en
Publication of CN109254567A publication Critical patent/CN109254567A/en
Pending legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/418Total 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/41845Total 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
    • YGENERAL 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
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02PCLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P80/00Climate change mitigation technologies for sector-wide applications
    • Y02P80/40Minimising material used in manufacturing processes
    • YGENERAL 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
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02PCLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P90/00Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
    • Y02P90/02Total 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

A kind of multi-axis industrial robot's control system based on FPGA
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.
CN201810755005.3A 2018-07-11 2018-07-11 A kind of multi-axis industrial robot's control system based on FPGA Pending CN109254567A (en)

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)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110768606A (en) * 2019-11-12 2020-02-07 佛山智能装备技术研究院 Hardware modularization control drives integrative device

Citations (17)

* Cited by examiner, † Cited by third party
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

Patent Citations (17)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
Title
刘雷: "基于FPGA的六轴工业机器人伺服系统设计与实现" *
李钟: "基于DSP+ARM的工业机器人控制系统设计与实现" *

Cited By (2)

* Cited by examiner, † Cited by third party
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
CN103522290B (en) Fieldbus Based distributed robot's control system
CN104391477A (en) Drive-control integrated networked intelligent controller
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
CN109015621A (en) A kind of multi-axis industrial robot's servo-system
CN102830644B (en) Five-axis high-speed dispensing robot servo control system
CN203250190U (en) Controller of industrial robot
CN105406710A (en) Integrated servo drive system of multi-axis mobile 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
CN111816039A (en) Electromechanical transmission control system and control method
CN107662210A (en) A kind of resistance to irradiation dynamic power machine hand control system
CN207924430U (en) a kind of robot controller
CN202572010U (en) Control system for spindle of three-dimensional numerical control machine tool
CN103978324A (en) Double-core five-shaft welding robot control system
CN203459804U (en) Digital control system of plasma cutting machine
CN105302031A (en) Control device and control method for piling carrying robot
CN206544182U (en) A kind of robot control system
CN105373109B (en) A kind of Delta robots control system
CN203094429U (en) Steering engine controller
CN103433607A (en) Digitalized plasma cutting machine control system
CN114505853B (en) Remote layered control method and system for industrial robot
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