CN105182847A - High-reliability dual-redundant CAN bus communication method applied in motion control system - Google Patents
High-reliability dual-redundant CAN bus communication method applied in motion control system Download PDFInfo
- Publication number
- CN105182847A CN105182847A CN201510536440.3A CN201510536440A CN105182847A CN 105182847 A CN105182847 A CN 105182847A CN 201510536440 A CN201510536440 A CN 201510536440A CN 105182847 A CN105182847 A CN 105182847A
- Authority
- CN
- China
- Prior art keywords
- bus
- joint
- control
- master controller
- redundant
- 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
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/0421—Multiprocessor system
-
- 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/25032—CAN, canbus, controller area network bus
-
- 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/25232—DCS, distributed control system, decentralised control unit
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Hardware Redundancy (AREA)
Abstract
Provided is a high-reliability dual-redundant CAN bus communication method applied in a motion control system. The method comprises: (1) using two CAN buses A and B for communication between a main controller and each joint controller; (2) initializing the two CAN buses; (3) the main controller sending joint position instructions of the joint controllers to each joint controller through the A bus and the B bus in an instruction sending period of a control period in a time sharing manner, and after sending, sending broadcast instructions to the A bus and the B bus; (4) each joint controller receiving the joint position instruction message through inquiring the A bus and the B bus, and analyzing and storing the instruction message which is received first; (5) each joint controller receiving broadcast instructions through inquiring the A bus and the B bus, after broadcast instructions are received, moving according to the analytic instruction message, and acquiring current state information, sending the respective state information to the main controller in timer interruption in a time sharing manner; and the next control period starting to execute from the step (3).
Description
Technical field
The present invention relates to a kind of CAN communication means, relate to a kind of highly reliable dual-redundant CAN bus communication means being applied to kinetic control system specifically.
Background technology
Distributed Motion Control System comprises a master controller and several joint controls, master controller mainly completes the planning of motion path, the position command cooked up is sent to each joint control, collects the positional information in each joint simultaneously, for follow-up movement locus is prepared.Need between master controller and joint control to set up a kind of quick, reliable communication mode.Communication mode in the past is mostly selected to set up point-to-point serial communication or analogue communication mode between master controller and each joint control, separate between each joint control, lacks a kind of highly reliable high speed communications link.
Summary of the invention
Technology of the present invention is dealt with problems and is: overcome the deficiencies in the prior art, provides a kind of highly reliable dual-redundant CAN bus communication means being applied to kinetic control system.
Technical solution of the present invention is: a kind of highly reliable dual-redundant CAN bus communication means being applied to kinetic control system, and described kinetic control system comprises a master controller and at least two joint controls; Step is as follows:
(1) will two CAN be adopted between master controller with each joint control to communicate, two CAN be designated as A bus and B bus backups each other and hardware circuit is separate, and every bar CAN both can receive data, also can send data;
(2) initialization two CAN, arrange the communication protocol of CAN;
(3) the joint position instruction of each joint control is sent to each joint control by A bus and B bus in the instruction transmit time segments timesharing of control cycle by master controller respectively, sends broadcasting instructions after being sent completely to A bus and B bus; Described control cycle comprises instruction transmit time segments and joint states information returns the period, and wherein joint states information returns the period and adopts the mode of Interruption to communicate;
(4) each joint control receives the joint position instruction message of master controller by inquiry A, B bus, and is carried out resolving by the instruction message first received and be saved in internal memory;
(5) each joint control receives broadcasting instructions by inquiry A, B bus, after receiving broadcasting instructions, each joint control moves according to the instruction message of resolving simultaneously, and gather current status information, in Interruption, respective status information is sent to master controller by timesharing; Next control cycle circulates execution from step (3).
The data receiving state of Real-Time Monitoring A bus, B bus in Interruption, when certain bus continuous t time does not receive the instruction message of master controller, this bus of initialization immediately, communication is switched to another bus, wait to enter into next control cycle, recover the mode of two bus redundancies, described t at least two control cycles.
The state of Real-Time Monitoring A bus, B bus in Interruption, t reads CAN error flag position at regular intervals, when this error flag position is set, this bus of initialization immediately, communication is switched to another bus, wait to enter into next control cycle, recover the mode of two bus redundancies, described t at least two control cycles.
The present invention compared with prior art beneficial effect is:
(1) the present invention proposes a kind of dual-redundant CAN bus that uses as the communication means of physical link, by self-defined CAN communication protocol, establish the digital communication highway between a master controller and multiple joint control, the reliability solving Distributed Motion Control System existence is low, the problems such as the Limited information of slow, the multiple joint motions poor synchronization of traffic rate, transmission.
(2) adopt two-way independently CAN realize the two redundancy backup of hardware, the mode adopting data message Real-Time Monitoring and CAN hardware state to detect in real time realizes the stripping of fault CAN, online switching mode is adopted to realize the Rapid reset of fault CAN, for the reliability of dual-redundant CAN bus communication provides guarantee;
(3) bus real-time is improved to the mode of multiple joints website employing director data time-sharing send, broadcast synchronous averaging, solve the shortcoming of multiple joint motions poor synchronization, improve the real-time of kinematic system, greatly strengthen the coordinated movement of various economic factors between multi-joint.
Accompanying drawing explanation
Fig. 1 is the topology diagram of dual-redundant CAN bus of the present invention;
Fig. 2 is kinetic control system control cycle schematic diagram of the present invention;
Fig. 3 is CAN data message Real-Time Monitoring process flow diagram of the present invention;
Fig. 4 is CAN hardware state Real-Time Monitoring process flow diagram of the present invention.
Embodiment
Elaborate to the present invention below in conjunction with drawings and Examples, the present invention relates to a kind of highly reliable dual-redundant CAN bus communication means being applied to kinetic control system, described kinetic control system comprises a master controller and at least two joint controls; This example is described for seven joint controls.Concrete steps are as follows:
(1) communicate adopting two CAN to carry out between master controller with each joint control (topological structure of dual-redundant CAN bus as shown in Figure 1), article two, CAN is designated as A bus and B bus backups each other and hardware circuit is separate, every bar CAN both can receive data, also can send data, namely form separate dual-redundant CAN bus communication;
(2) initialization two CAN, arrange the communication protocol of CAN;
Carry out digital communication by the CAN that two-way is identical between master controller with each joint control, master controller sends to the instruction message of joint control to be divided into two kinds: steering order and broadcasting instructions.The effect of broadcasting instructions be synchronous each joint motion, determine to return frame information.The message that each joint control returns to master controller only has one: status return message.The information such as the joint position information of joint control collection are returned to master controller by status return message, adjust movement locus at any time for master controller.
The present invention can select identical for the definition of the communication protocol of CAN A, B, and message is defined as follows shown in table.
Consider the reason that kinetic control system is high to requirement of real-time, the communication speed of CAN A, B can be selected to be 1Mbit/s, what then master controller sent 7 location message to 7 joint controls T.T. is about 0.7ms, and the time sending broadcast is about 0.1ms.
Theory calculate and test findings show, master controller completes 1 path planning and sends to 7 joint controls to by 7 joint position command signals, and start the mistiming of simultaneously moving in joint and be about 0.8ms, being enhanced than serial data transmission such as RS232 in the past.Meet the strong request of Distributed Motion Control System to traffic rate.
(3) the joint position instruction of each joint control is sent to each joint control by A bus and B bus at the instruction transmit time segments of control cycle by master controller respectively, sends broadcasting instructions after being sent completely to A bus and B bus; Described control cycle comprises instruction transmit time segments and joint states information returns the period, and wherein joint states information returns the period and adopts the mode of Interruption to communicate; Such as shown in Figure 2, the control cycle of kinetic control system is 20ms, wherein the duration of instruction transmit time segments is 2ms, within the 2ms period, master controller is to each joint control distribution steering order (joint position instruction), after completing each joint control instruction distribution, master controller finally sends broadcast frame instruction, with the motion in this synchronous each joint.
(4) each joint control receives the joint position instruction message of master controller by inquiry A, B bus, and is carried out resolving by the instruction message first received and be saved in internal memory;
(5) each joint control receives broadcasting instructions by inquiry A, B bus, after receiving broadcasting instructions, each joint control moves according to the instruction message of resolving simultaneously, and gather current status information, in Interruption, respective status information is sent to master controller by timesharing; Next control cycle circulates execution from step (3).
It is not simultaneously that joint control returns joint states information, but timesharing returns, reduce the load factor of communication bus with this, such as, feed back at once after No. 1 joint control receives broadcast frame, if feedback multiframe data, then two PWM cycles of time delay between frame and frame; After No. 2 joint controls receive broadcast frame, time delay 40 timing cycles feed back, if feedback multiframe data, then and two PWM cycles of time delay between frame and frame; After No. 3 joint controls receive broadcast frame, time delay 80 timing cycles feed back, if feedback multiframe data, then and two PWM cycles of time delay between frame and frame, by that analogy.Therefore can be reduced the total inorganic nitrogen of system by time-sharing send data, improve the reliability of system.
In order to improve reliability, in Interruption, the mode of data message Real-Time Monitoring and CAN hardware state Real-Time Monitoring is adopted to realize the stripping of fault CAN.Data message Real-Time Monitoring is when certain the continuous 50ms of CAN does not receive the instruction message of master controller, then show that mistake appears in communication, this CAN of initialization immediately, communication is simultaneously switched to another CAN, wait to enter into next control cycle, recover the mode of two bus redundancies.CAN hardware state Real-Time Monitoring in Interruption, reads CAN error flag position at regular intervals (this is the error flag position that dsp chip carries, be mainly used in characterizing CAN communications status, whether CAN such as, there is format error, whether there is fill-error), if this error flag position is set, then this CAN of initialization immediately, communication is simultaneously switched to another CAN, wait to enter into next control cycle, recover the mode of two bus redundancies.Therefore dual-redundant CAN bus malfunction monitoring and the low reliability in real time in the changing method communication process of solving over, improve the security of system.As shown in Figure 3, hardware state Real-Time Monitoring process flow diagram as shown in Figure 4 for CAN data message Real-Time Monitoring process flow diagram.
The unspecified part of the present invention belongs to general knowledge as well known to those skilled in the art.
Claims (3)
1. be applied to a highly reliable dual-redundant CAN bus communication means for kinetic control system, described kinetic control system comprises a master controller and at least two joint controls; It is characterized in that step is as follows:
(1) will two CAN be adopted between master controller with each joint control to communicate, two CAN be designated as A bus and B bus backups each other and hardware circuit is separate, and every bar CAN both can receive data, also can send data;
(2) initialization two CAN, arrange the communication protocol of CAN;
(3) the joint position instruction of each joint control is sent to each joint control by A bus and B bus in the instruction transmit time segments timesharing of control cycle by master controller respectively, sends broadcasting instructions after being sent completely to A bus and B bus; Described control cycle comprises instruction transmit time segments and joint states information returns the period, and wherein joint states information returns the period and adopts the mode of Interruption to communicate;
(4) each joint control receives the joint position instruction message of master controller by inquiry A, B bus, and is carried out resolving by the instruction message first received and be saved in internal memory;
(5) each joint control receives broadcasting instructions by inquiry A, B bus, after receiving broadcasting instructions, each joint control moves according to the instruction message of resolving simultaneously, and gather current status information, in Interruption, respective status information is sent to master controller by timesharing; Next control cycle circulates execution from step (3).
2. a kind of highly reliable dual-redundant CAN bus communication means being applied to kinetic control system according to claim 1, it is characterized in that: the data receiving state of Real-Time Monitoring A bus, B bus in Interruption, when certain bus continuous t time does not receive the instruction message of master controller, this bus of initialization immediately, communication is switched to another bus, wait to enter into next control cycle, recover the mode of two bus redundancies, described t at least two control cycles.
3. a kind of highly reliable dual-redundant CAN bus communication means being applied to kinetic control system according to claim 1 and 2, it is characterized in that: the state of Real-Time Monitoring A bus, B bus in Interruption, t reads CAN error flag position at regular intervals, when this error flag position is set, this bus of initialization immediately, is switched to another bus by communication, wait to enter into next control cycle, recover the mode of two bus redundancies, described t at least two control cycles.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510536440.3A CN105182847A (en) | 2015-08-27 | 2015-08-27 | High-reliability dual-redundant CAN bus communication method applied in motion control system |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510536440.3A CN105182847A (en) | 2015-08-27 | 2015-08-27 | High-reliability dual-redundant CAN bus communication method applied in motion control system |
Publications (1)
Publication Number | Publication Date |
---|---|
CN105182847A true CN105182847A (en) | 2015-12-23 |
Family
ID=54904992
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510536440.3A Pending CN105182847A (en) | 2015-08-27 | 2015-08-27 | High-reliability dual-redundant CAN bus communication method applied in motion control system |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105182847A (en) |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105843764A (en) * | 2016-04-07 | 2016-08-10 | 大族激光科技产业集团股份有限公司 | Robot control method and device |
CN107024875A (en) * | 2017-04-21 | 2017-08-08 | 钟阳光 | A kind of motion control real-time communication method based on CAN network |
CN107132799A (en) * | 2017-06-21 | 2017-09-05 | 湖南利能科技股份有限公司 | A kind of apparatus and method of many MCU data interactions intelligent acquisitions |
CN110262214A (en) * | 2019-07-22 | 2019-09-20 | 北京航天发射技术研究所 | Play perpendicular control system |
CN110568780A (en) * | 2018-06-05 | 2019-12-13 | 中国科学院宁波材料技术与工程研究所 | Master-slave cooperative motion control system |
CN111010259A (en) * | 2019-12-25 | 2020-04-14 | 香港大德昌龙生物科技有限公司 | Communication method and apparatus, in-vitro diagnostic device, computer-readable storage medium |
CN112859711A (en) * | 2021-02-07 | 2021-05-28 | 航天科工空间工程发展有限公司 | Spacecraft CAN bus autonomous switching processing system and method |
CN113219421A (en) * | 2021-02-05 | 2021-08-06 | 南京恩瑞特实业有限公司 | Secondary radar state monitoring system based on CAN bus |
WO2022199000A1 (en) * | 2021-03-26 | 2022-09-29 | 深圳市优必选科技股份有限公司 | Control method, control system and intelligent device |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1843526A1 (en) * | 2006-04-05 | 2007-10-10 | Nec Electronics (Europe) GmbH | Data communication system based on serial buses |
CN201804257U (en) * | 2010-08-11 | 2011-04-20 | 华锐风电科技(江苏)有限公司 | Pitch control system for wind power generator set based on CAN bus redundancy |
CN102055633A (en) * | 2010-09-29 | 2011-05-11 | 航天东方红卫星有限公司 | Satellite-borne double-CAN (Controller Area Network) bus node failure self-restoration system |
CN103634150A (en) * | 2013-12-03 | 2014-03-12 | 合肥工大高科信息科技股份有限公司 | Redundant high-safety CAN (controller area network) bus communication system and communication method thereof |
CN104690726A (en) * | 2014-08-29 | 2015-06-10 | 北京精密机电控制设备研究所 | Motion control system for space manipulator |
-
2015
- 2015-08-27 CN CN201510536440.3A patent/CN105182847A/en active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1843526A1 (en) * | 2006-04-05 | 2007-10-10 | Nec Electronics (Europe) GmbH | Data communication system based on serial buses |
CN201804257U (en) * | 2010-08-11 | 2011-04-20 | 华锐风电科技(江苏)有限公司 | Pitch control system for wind power generator set based on CAN bus redundancy |
CN102055633A (en) * | 2010-09-29 | 2011-05-11 | 航天东方红卫星有限公司 | Satellite-borne double-CAN (Controller Area Network) bus node failure self-restoration system |
CN103634150A (en) * | 2013-12-03 | 2014-03-12 | 合肥工大高科信息科技股份有限公司 | Redundant high-safety CAN (controller area network) bus communication system and communication method thereof |
CN104690726A (en) * | 2014-08-29 | 2015-06-10 | 北京精密机电控制设备研究所 | Motion control system for space manipulator |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105843764A (en) * | 2016-04-07 | 2016-08-10 | 大族激光科技产业集团股份有限公司 | Robot control method and device |
CN105843764B (en) * | 2016-04-07 | 2019-02-12 | 大族激光科技产业集团股份有限公司 | The control method and device of robot |
CN107024875A (en) * | 2017-04-21 | 2017-08-08 | 钟阳光 | A kind of motion control real-time communication method based on CAN network |
CN107132799A (en) * | 2017-06-21 | 2017-09-05 | 湖南利能科技股份有限公司 | A kind of apparatus and method of many MCU data interactions intelligent acquisitions |
CN110568780A (en) * | 2018-06-05 | 2019-12-13 | 中国科学院宁波材料技术与工程研究所 | Master-slave cooperative motion control system |
CN110262214A (en) * | 2019-07-22 | 2019-09-20 | 北京航天发射技术研究所 | Play perpendicular control system |
CN111010259A (en) * | 2019-12-25 | 2020-04-14 | 香港大德昌龙生物科技有限公司 | Communication method and apparatus, in-vitro diagnostic device, computer-readable storage medium |
CN113219421A (en) * | 2021-02-05 | 2021-08-06 | 南京恩瑞特实业有限公司 | Secondary radar state monitoring system based on CAN bus |
CN112859711A (en) * | 2021-02-07 | 2021-05-28 | 航天科工空间工程发展有限公司 | Spacecraft CAN bus autonomous switching processing system and method |
WO2022199000A1 (en) * | 2021-03-26 | 2022-09-29 | 深圳市优必选科技股份有限公司 | Control method, control system and intelligent device |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105182847A (en) | High-reliability dual-redundant CAN bus communication method applied in motion control system | |
CN103455005B (en) | Controller redundancy and switching method | |
CN102752093B (en) | Based on the data processing method of distributed file system, equipment and system | |
CN110034983A (en) | Home equipment interlock method and system based on Publish-subscribe message processing facility | |
CN101807076A (en) | Duplication redundancy fault-tolerant high-reliability control system having cooperative warm standby function based on PROFIBUS field bus | |
JP6594567B2 (en) | Method and system for synchronization between robot and server | |
CN108082219B (en) | 2-by-2-out-of-2 redundant structure data processing method | |
CN103176870A (en) | Multi-mode information interaction redundancy safety computer platform | |
CN113726556B (en) | Edge internet of things proxy node operation and maintenance method, system, storage medium and computing equipment | |
CN104767665A (en) | Ring communication network master station redundancy method, device and system | |
CN105357057A (en) | Center-free monitoring management node off-site redundancy method | |
CN105471653A (en) | Airborne dual channel seamless switching method and system | |
CN105681131B (en) | Main preparation system and its parallel output method | |
CN104639867A (en) | Method and system for resuming video conferences | |
CN109245926A (en) | Intelligent network adapter, intelligent network adapter system and control method | |
CN107942981A (en) | The cooperative control method of stage multiple spot servo-drive | |
CN104782173B (en) | Forwarding surface moving method, controller and gateway | |
CN103309319A (en) | Distributive redundancy type automatic power distribution control system for airplane | |
CN102866698A (en) | Human machine interface (HMI) redundant communication method for distributed control system controller | |
CN103441878A (en) | Method and device for processing ownership of PE device in VCF network | |
CN107040932A (en) | AGV communication systems and its communicating control method based on double wireless communication channels | |
CN104767664A (en) | Ring communication network slave node increasing and decreasing method, device and system | |
CN103048920B (en) | Hot standby service redundant control method and system for container water chilling unit | |
CN113535232A (en) | Heating and ventilation cloud edge cooperative system | |
CN107861494B (en) | The real-time detection and Synchronization of multi_motor control device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into 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: 20151223 |