CN1622062A - Distributed underwater robot control system - Google Patents
Distributed underwater robot control system Download PDFInfo
- Publication number
- CN1622062A CN1622062A CN 200310105200 CN200310105200A CN1622062A CN 1622062 A CN1622062 A CN 1622062A CN 200310105200 CN200310105200 CN 200310105200 CN 200310105200 A CN200310105200 A CN 200310105200A CN 1622062 A CN1622062 A CN 1622062A
- Authority
- CN
- China
- Prior art keywords
- node
- network
- data
- program
- driver
- 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.)
- Granted
Links
- 238000012545 processing Methods 0.000 claims abstract description 18
- 238000001514 detection method Methods 0.000 claims abstract description 17
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims abstract description 13
- 238000000034 method Methods 0.000 claims description 21
- 230000006870 function Effects 0.000 claims description 18
- 238000007726 management method Methods 0.000 claims description 12
- 238000004891 communication Methods 0.000 claims description 10
- 230000008569 process Effects 0.000 claims description 8
- 230000005540 biological transmission Effects 0.000 claims description 4
- 238000005070 sampling Methods 0.000 claims description 4
- 238000004364 calculation method Methods 0.000 claims description 3
- 238000013500 data storage Methods 0.000 claims description 3
- 230000008901 benefit Effects 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 16
- 238000006243 chemical reaction Methods 0.000 description 5
- 238000005516 engineering process Methods 0.000 description 5
- 230000008859 change Effects 0.000 description 3
- 230000005611 electricity Effects 0.000 description 3
- 230000002093 peripheral effect Effects 0.000 description 2
- 206010033799 Paralysis Diseases 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000018109 developmental process Effects 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 230000033772 system development Effects 0.000 description 1
Images
Landscapes
- Manipulator (AREA)
- Small-Scale Networks (AREA)
Abstract
A distributed underwater robot control system adopts an RS-485 network as a core of distributed control and consists of a computer host node and RS-485 network nodes, wherein the computer host node distributes tasks to each network node for execution and comprises a computer host and an RS-232/RS-485 converter, the RS-485 network nodes take a single chip microcomputer as a core and mainly comprise a system state detection node, an equipment power supply control node, a power supply management node, a motor control node, an emergency processing node, a data acquisition node and a serial port equipment node, and each network node is mainly responsible for data acquisition and processing of a sensor, control of a carried device, motor drive control, fault detection, water leakage detection and emergency processing tasks; the computer host nodes and all the RS-485 network nodes are connected together through RS-485 interfaces to form an RS-485 network; the software consists of a computer host program and each singlechip program. The invention has the advantages of modularization, strong expandability, flexible configuration, high reliability and the like.
Description
Technical field
The present invention relates to the underwater robot control technology, robot control system under specifically a kind of distributed water, it belongs to the computerized equipment that is used in underwater robot control.
Background technology
Conventional underwater robot control system, Control System for Autonomous Underwater Vehicle particularly, the centralized control mode of many employings realizes ROBOT CONTROL, promptly by data acquisition and the control of main control computer realization to all the sensors and equipment, main control computer is gathered voltage by A/D conversion circuit, analog signalses such as electric current, by digital quantity input circuit collecting device switching signal, gather the data of serial equipment by serial port circuit, after main control computer is handled these data, by D/A conversion circuit output controlled quentity controlled variable drive motor, equipment is controlled by the digital quantity output circuit output switching signal.Thereby the task of main control computer is heavy under the centralized control mode, and efficient is also low; In case main control computer breaks down, The whole control system will be paralysed, and the reliability of system is low; Because data acquisition channel, address and the interrupt resources of main control computer and the core number of watertight cable are limited, be difficult to random increase equipment or sensor, the poor expandability of system.Along with the development of electronic technology, sensor technology, mechanics of communication, the sensor that underwater robot can carry is more and more, and the mission of finishing is also increasingly sophisticated, and traditional centralized control method can't satisfy the demand of underwater robot control system development.
Summary of the invention
In order to overcome above-mentioned deficiency, the purpose of this invention is to provide a kind ofly have that extensibility is strong, configuration flexibly, robot control system under good, the high efficiency of software generic, safe, distributed water that reliability is high.
To achieve these goals, technical scheme of the present invention is: adopt the core of RS-485 network as distributed control, hardware is made up of main frame node and RS-485 network node, wherein the main frame node comprises main frame and RS-232/RS-485 converter, the RS-485 network node is core with the single-chip microcomputer, mainly comprises system state detection node, device power supply (DPS) Control Node, power management node, Electric Machine Control node, emergency processing node, data acquisition node, serial equipment node; Main frame node and all RS-485 network nodes all link together by the RS-485 interface, constitute the RS-485 network; Software is made up of main frame program and each Single Chip Microcomputer (SCM) program, wherein the main frame program comprises RS-485 network driver, each RS-485 network node driver, RS-485 user interface built-in function, and Single Chip Microcomputer (SCM) program mainly comprises system state trace routine, device power supply (DPS) control program, power management routines, Electric Machine Control program, emergency processing program, data acquisition program, serial equipment program;
Wherein: the serial ports of main frame is connected on the RS-485 network by the RS-232/RS-485 converter, by the single chip communication of RS-485 network and each RS-485 network node, the microcontroller serial port of each RS-485 network node is connected on the RS-485 network by the RS-485 chip for driving;
Described RS-485 network driver is responsible for driving the RS-232/RS-485 converter, adopts information communication method to realize the exchanges data of RS-485 network node driver and each single-chip microcomputer node procedure; Idiographic flow is: accreditation process name at first after the startup, the time that is provided with interrupts and serial ports interrupts, program enters the circular wait state then, if timing arrives, the generation time message of interrupting then, program judges whether successfully received data last time, if a certain task successful then in 1～task n is executed the task in the execution distribution, current task promptly is set for to carry out message exchange with a certain driver, then calculation check and and send serial data to the RS-485 network, the transmission program that finishes is in the circular wait message status, if receive serial data then produce the serial ports interrupt message, if Data Receiving success and correct then data are sent to the driver of this node; If timing does not then receive the correct data of certain node yet, then recommunicate, as still not receiving correct data, then think this node failure, and fault is sent to this node driver by message exchange; Task 1～task n in the program is a task list, and program decides what task of execution according to a counter from 1 to n, promptly communicates with certain node, and this task list can be formulated according to the difference sampling frequency requirement to different nodes;
Described RS-485 network node driver comprises drivers such as system state detection node, device power supply (DPS) Control Node, power management node, Electric Machine Control node, emergency processing node, data acquisition node, serial equipment node, each driver is responsible for realizing the control to this node device, and the structure of each network node driver is identical; Idiographic flow enters in the circulation that waits for the arrival of news then for accreditation process name at first after starting; If receive the message of RS-485 driver, then carry out exchanges data with the RS-485 driver; If receive the message that the user interface storehouse sends, then judge task type according to the content of message; Task has two types: reading of data order and the order of control output data, if reading of data order, program just is treated to quantities to corresponding data, if control output data order, just the data that receive from the user interface storehouse are handled and are stored in the internal memory, send to the RS-485 network node during by the time with RS-485 driver swap data; After executing above-mentioned task, program and interface library function swap data send to the user interface built-in function to the data and the failure code that obtain;
The Single Chip Microcomputer (SCM) program of described RS-485 network node node is communicated by letter with computer node by the RS-485 network, moves according to the order of main frame, and sends the data to computer node; The Single Chip Microcomputer (SCM) program idiographic flow of each RS-485 network node is: carry out initialization during program run earlier, wait for that then serial ports interrupts, in serial ports interrupted, program received the data of RS-485 network and carries out according to the order that receives, and sends data to the RS-485 network; In timer interrupted, program was carried out tasks such as data acquisition, control output, calculating, data storage simultaneously according to the needs of different nodes;
The upper strata Control Software that described RS-485 user interface built-in function adopts the file destination form to offer user's establishment is called, and realizes visit to each RS-485 network node driver data by information communication method and shared drive method.
Compared with prior art, the present invention has more following advantage:
1. system works efficient height.The present invention is a kind of based on robot control system under the distributed water of RS-485 bus, it is distributed to each sensor and device node execution with the centralized control task main frame of bus form, a part of task of main control computer can be distributed to each network node realizes, alleviate the task of main control computer greatly, realized the raising of system effectiveness.
2. safe, in case adopt the present invention's main control computer to break down, the emergent node of fault can independently be worked, and finishes emergency processing work, does the great security that improves underwater robot like this.
3. reliability height.The present invention adopts that the line of each node has only power lead and data line after the bus network form, significantly reduced the quantity and the core number of watertight cable, and underwater electrical connector leaks and the probability of line fault thereby reduced.
4. software generic is good.Program of the present invention adopts modular design, it has open framework, configuration is flexible, can increase or reduce entrained sensor and equipment arbitrarily, can not cause the significantly change of system hardware circuit again, so can expand, easily transplant, both can be used for having cable underwater robot control, can be used for not having cable underwater robot control again, applied range.
5. system extension is strong.When adopting the present invention to increase and decrease sensor or device node in advance, need only insert it in bus network and move the driver of this node, need not change main control computer hardware, the maximum node number on this bus can be 128.
Description of drawings
Fig. 1 is a hardware composition frame chart of the present invention.
Fig. 2-the 1st, system state detection node hardware structure diagram of the present invention.
Fig. 2-the 2nd, system state detection node hardware elementary diagram of the present invention.
Fig. 3-the 1st, device power supply (DPS) Control Node hardware structure diagram of the present invention.
Fig. 3-the 2nd, device power supply (DPS) Control Node hardware elementary diagram of the present invention.
Fig. 4-the 1st, power management node hardware structure diagram of the present invention.
Fig. 4-the 2nd, power management node hardware elementary diagram of the present invention.
Fig. 5-the 1st, Electric Machine Control node hardware structure diagram of the present invention.
Fig. 5-the 2nd, Electric Machine Control node hardware elementary diagram of the present invention.
Fig. 6-the 1st, emergency processing node hardware structure diagram of the present invention.
Fig. 6-the 2nd, emergency processing node hardware elementary diagram of the present invention.
Fig. 7-the 1st, data acquisition node hardware structure diagram of the present invention.
Fig. 7-the 2nd, data acquisition node hardware elementary diagram of the present invention.
Fig. 8-the 1st, serial equipment node hardware structure diagram of the present invention.
Fig. 8-the 2nd, serial equipment node hardware elementary diagram of the present invention.
Fig. 9 is a software composition frame chart of the present invention.
Figure 10 is a main frame RS-485 network driver software flow pattern of the present invention.
Figure 11 is each RS-485 network node driver software process flow diagram of main frame of the present invention.
Figure 12 is each single-chip microcomputer node software process flow diagram of the present invention.
Embodiment
Below in conjunction with drawings and Examples the present invention is described in further detail.
The present invention adopts the core of RS-485 network as distributed control, the RS-485 network node that hardware is made up of main frame node, a plurality of single-chip microcomputer is formed, wherein the main frame node comprises main frame and RS-232/RS-485 converter, and the RS-485 network node mainly comprises system state detection node, device power supply (DPS) Control Node, power management node, Electric Machine Control node, emergency processing node, data acquisition node, serial equipment node; Main frame node and all RS-485 network nodes all link together by the RS-485 interface, constitute the RS-485 network; Software is made up of the Single Chip Microcomputer (SCM) program of main frame program and each RS-485 network node, its program comprises RS-485 network driver, each RS-485 network node driver, RS-485 user interface built-in function composition, and the upper strata Control Software that RS-485 user interface storehouse adopts the form of file destination to offer user's establishment is called.
Computer operating system is QNX, and program adopts the establishment of WATCOM C language, and Single Chip Microcomputer (SCM) program adopts the establishment of C language, is stored in the electricity erasable memorizer of single-chip microcomputer.
As shown in Figure 1, the serial ports of main frame is connected on the RS-485 network by the RS-232/RS-485 converter, communicate by letter with each RS-485 network node, main frame be responsible for underwater robot motion control, mission download, data recording, with the tasks such as information interaction of each single-chip microcomputer node, the RS-232/RS485 converter is realized the hardware level conversion between main frame serial ports RS-232 and the RS-485, realizes (the conversion of 9600bps～115200bps) and RS-485 network baud rate (250kbps) of main frame serial ports baud rate; The microcontroller serial port of each RS-485 network node is connected on the RS-485 network by RS-485 chip for driving (as: MAX487), and each RS-485 network node is equipped with different peripheral hardwares according to its difference that realizes function, drives as A/D, D/A, I/O etc.
Shown in Fig. 2-1, the system state detection node is core with the single-chip microcomputer, be responsible for operating voltage, pressure chamber pressure, the state that leaks, the underwater robot of detection computations machine system and go into water state etc., and be connected to the RS-485 chip for driving by serial ports, realize RS-485 interface and RS-485 network exchange data.Shown in Fig. 2-2, the 1st single-chip microcomputer DA1-2 adopts the AT90S8535 chip, the operating voltage of three passage detection computations of the A/D0～A/D2 machine system by terminal J1-3, signals such as five passage detected pressures of the A/D3～A/D7 cabin pressure by terminal J1-3, temperature, DI1～DI4 by terminal J1-4 detects four road signals that leak, DI5 by terminal J1-4 detects underwater robot entry signal, the serial ports of the 1st single-chip microcomputer DA1-2 is connected to 1RS-485 chip for driving DA1-1, and 1RS-485 chip for driving DA1-1 is connected with the RS-485 network by terminal J1-2.Terminal J1-1 is used for the online download (as follows) of Single Chip Microcomputer (SCM) program in addition.
Shown in Fig. 3-1, the device power supply (DPS) Control Node is core with the single-chip microcomputer, by the order of RS-485 interface receiving computer main frame, opens or closes according to the power supply relay of each equipment of command driven, detects the open and-shut mode of each device power supply (DPS) simultaneously.Shown in Fig. 3-2, the 2nd single-chip microcomputer DA2-2 adopts the AT90S8535 chip, the 2nd single-chip microcomputer DA2-2 is by the break-make of the 1st～4 relay K 2-1～K2-4 control terminal J2-3 power supply, and the on off state by resistance detection feedback power supply, the serial ports of the 2nd single-chip microcomputer DA2-2 is connected with 2RS-485 chip for driving DA2-1, and 2RS-485 chip for driving DA2-1 is connected to the RS-485 network by terminal J2-2.
Shown in Fig. 4-1, the power management node is core with the single-chip microcomputer, is responsible for detecting cell voltage, electric current, temperature, pressure and the state that leaks, and consumed power is calculated and is stored, and data are sent to main frame by the RS-485 interface.Shown in Fig. 4-2, the 3rd single-chip microcomputer DA3-2 adopts the AT90S8535 chip, the 3rd single-chip microcomputer DA3-2 is by DA3-3 (adopting the AD590 chip) detected temperatures signal, A/D1, A/D2 by terminal J3-3 detect the two-way battery voltage signal, A/D3～A/D6 by terminal J3-3 detects cell voltage, electric current, temperature, pressure four road signals, detect the two-way signal that leaks by terminal J3-4, the serial ports of the 3rd single-chip microcomputer DA3-2 is connected to 3RS-485 chip for driving DA3-1, and 3RS-485 chip for driving DA3-1 is connected to the RS-485 network by terminal J3-2.
Shown in Fig. 5-1, the Electric Machine Control node is core with the single-chip microcomputer, order by RS-485 interface receiving computer main frame, according to the electric power starting of each motor of command driven or close, control D/A drive motor driver module, single-chip microcomputer detects the electrical fault state simultaneously, gathers motor working current, motor drive module temperature by A/D, and sends to main frame by the RS-485 interface.Shown in Fig. 5-2, the 4th single-chip microcomputer DA4-2 adopts the AT90S8535 chip, the 4th single-chip microcomputer DA4-2 is by temperature sensor DA4-3 detected temperatures signal, A/D1～A/D4 by terminal J4-4 detects four road motor current signals, by the 1st～2 D/A DA4-4, DA4-5 (adopt AD7303 chip) output four road analog voltage signals to terminal J4-5 as motor-driven to determining voltage signal, the power supply of controlling No. four motors by the 5th～8 relay K 4-1～K4-4 outputs to terminal J4-6, detect four tunnel motor failure signal by terminal J4-3, the serial ports of the 4th single-chip microcomputer DA4-2 is connected to 4RS-485 chip for driving DA4-1, and 4RS-485 chip for driving DA4-1 is connected to the RS-485 network by terminal J4-2.
Shown in Fig. 6-1, the emergency processing node is core with the single-chip microcomputer, serial ports of single-chip microcomputer is connected with the RS-485 chip for driving, form the RS-485 interface, another serial ports is connected with wireless station, is used to control wireless station and sends, and it can independently be worked when the main frame fault, and after robot emerged under water, control wireless station sent.Shown in Fig. 6-2, the 5th single-chip microcomputer DA5-2 adopts the AT90S8535 chip, the 5th single-chip microcomputer DA5-2 detects the two-way voltage signal by terminal J5-3, detect the signal that leaks by terminal J5-4, export the two-way power supply to terminal J5-5 by the 9th～10 relay K 5-1～K5-2, by terminal J5-6 control wireless station, the serial ports of the 5th single-chip microcomputer DA5-2 is connected to 5RS-485 chip for driving DA5-1, and 5RS-485 chip for driving DA5-1 is connected to the RS-485 network by terminal J5-2.
Shown in Fig. 7-1, data acquisition node is a core with single-chip microcomputer and high-precision a/d converter, can the sampling depth meter, analog quantity such as altitude gauge, and image data sent to main frame by the RS-485 network.Shown in Fig. 7-2, the 6th single-chip microcomputer DA6-2 adopts the AT90S2313 chip, the 6th single-chip microcomputer DA6-2 gathers the voltage signal that terminal J6-3 introduces by the 1st A/D converter DA6-4 (adopting the AD7714 chip), the serial ports of the 6th single-chip microcomputer DA6-2 is connected to 6RS-485 chip for driving DA6-1, and 6RS-485 chip for driving DA6-1 is connected to the RS-485 network by terminal J6-2.
Shown in Fig. 8-1, serial ports of serial equipment node is connected with the RS-485 chip for driving, form the RS-485 interface, another serial ports is connected with the RS-232 chip for driving, form RS-232 interface, this node major function is that it realizes the conversion of RS-232 and RS-485 level and agreement with the equipment access RS-485 network of RS-232, and this node can connect serial equipments such as GPS, altitude gauge, electronic compass.Shown in Fig. 8-2, the 7th single-chip microcomputer DA7-2 adopts the AT90S2313 chip, the PD2 of the 7th single-chip microcomputer DA7-2, PD3 pin are connected to 7RS-232 chip for driving DA7-3,7RS-232 chip for driving DA7-3 is connected to the RS-232 serial equipment by terminal J7-3, the serial ports of the 7th single-chip microcomputer DA7-2 is connected to 7RS-485 chip for driving DA7-1, and 7RS-485 chip for driving DA7-1 is connected to the RS-485 network by J7-2.
As shown in Figure 9, software is made up of main frame program and each Single Chip Microcomputer (SCM) program, the computing machine master routine comprises RS-485 network driver, each RS-485 network node driver, RS-485 user interface built-in function, the RS-485 network driver is responsible for driving the RS-232/RS-485 converter, adopts information communication method to realize the exchanges data of RS-485 network node driver and each single-chip microcomputer node procedure; RS-485 network node program comprises drivers such as system state detection node, device power supply (DPS) Control Node, power management node, Electric Machine Control node, emergency processing node, data acquisition node, serial equipment node, and each driver is responsible for realizing the control to this node device; RS-485 user interface built-in function offers the upper strata Control Software of user establishment and calls, and realizes visit to each RS-485 network node driver data by information communication method and shared drive method; RS-485 network driver and each RS-485 network node driver can independent operatings, after main frame powers on, the automatic load and execution RS-485 network driver of system and each RS-485 network node driver, also can be in the middle of system operation, according to the start and stop of the operating position of hardware device node with each RS-485 network node driver of programmed control; RS-485 user interface built-in function adopts the form of file destination to provide, the upper strata Control Software is by compiling the visit of realization to the RS-485 network equipment with RS-485 user interface built-in function, can return a code when calling RS-485 user interface built-in function, it has represented fault status information; Single Chip Microcomputer (SCM) program adopts the establishment of C language, be stored in behind the compilation in the electricity erasable memorizer of single-chip microcomputer, back operation automatically powers on, communicate with other node then, the order that receives other node line operate of going forward side by side, each single-chip microcomputer node all has a fixing address, and its scope from 0 to 127 is in order to distinguish different nodes.
As shown in figure 10, the RS-485 network driver is responsible for driving the RS-232/RS-485 converter, adopts information communication method to realize the exchanges data of RS-485 network node driver and each single-chip microcomputer node procedure; Idiographic flow is: accreditation process name at first after the startup, the time that is provided with interrupts and serial ports interrupts, program enters the circular wait state then, if timing is to (as 30 milliseconds), the generation time message of interrupting then, program judges whether successfully received data last time, if a certain task successful then in 1～task n is executed the task in the execution distribution, current task promptly is set for to carry out message exchange with a certain driver, then calculation check and and send serial data to the RS-485 network, the transmission program that finishes is in the circular wait message status, if receive serial data then produce the serial ports interrupt message, if Data Receiving success and correct then data are sent to the driver of this node; If timing does not then receive the correct data of certain node yet, then recommunicate, as still not receiving correct data, then think this node failure, and fault is sent to this node driver by message exchange; Task 1～task n in the program is a task list, and program decides what task of execution according to a counter from 1 to n, promptly communicates with certain node, and this task list can be formulated according to the difference sampling frequency requirement to different nodes.
RS-485 network node program idiographic flow comprises drivers such as system state detection node, device power supply (DPS) Control Node, power management node, Electric Machine Control node, emergency processing node, data acquisition node, serial equipment node, and each driver is responsible for realizing the control to this node device.The structure of each network node driver is the same substantially, and as shown in figure 11, accreditation process name at first behind the program start enters in the circulation that waits for the arrival of news then.If receive the message of RS-485 driver, then carry out exchanges data with the RS-485 driver; If receive the message that the user interface storehouse sends, then judge task type according to the content of message.Task has two types: reading of data order and the order of control output data, if reading of data order, program just is treated to quantities to corresponding data, if control output data order, just the data that receive from the user interface storehouse are handled and are stored in the internal memory, send to the RS-485 network node during by the time with RS-485 driver swap data.After executing above-mentioned task, program and interface library function swap data send to the user interface built-in function to the data and the failure code that obtain.
Single Chip Microcomputer (SCM) program adopts the establishment of C language, is stored in behind the compilation in the electricity erasable memorizer of single-chip microcomputer, and the back operation automatically that powers on communicates with other node then, the order that receives other node line operate of going forward side by side.The difference of finishing the work according to each node, the order difference of carrying out in the program, but the Single Chip Microcomputer (SCM) program structure of each RS-485 network node node is the same substantially, as shown in figure 12, idiographic flow is: carry out initialization during program run earlier, wait for that then serial ports interrupts, in serial ports interrupts, program receives the data of RS-485 network and carries out according to the order that receives, and to RS-485 network transmission data, in timer interrupted, program was carried out tasks such as data acquisition, control output, calculating, data storage simultaneously according to the needs of different nodes.
Described main frame adopts conventional low-power consumption, the small size industrial computer that has serial ports, as STD, PC/104 industrial computer etc.RS-232/RS-485 converter and Chip Microcomputer A/D, D/A, peripheral circuit interfacing are existing electronic technology, and single-chip microcomputer can adopt conventional chip microcontroller such as 51 series, PIC series, AT90 series.
In a word, the present invention is distributed to each sensor and device node execution with the centralized control task main frame of bus form, thereby the main frame task is alleviated, and system effectiveness improves; In case main frame breaks down, the emergency processing node can independently be worked, and finishes emergency processing work, so the reliability height of system; It has open framework, can increase or reduce entrained sensor and equipment arbitrarily, can not cause the significantly change of system hardware circuit, and it has also reduced the core number of watertight cable simultaneously, reduces the probability that cable loose contact or cable splice leak.
Claims (6)
1. robot control system under the distributed water, it is characterized in that: adopt the core of RS-485 network as distributed control, hardware is made up of main frame node and RS-485 network node, wherein the main frame node is distributed to each network node execution with task, it comprises main frame and RS-232/RS-485 converter, the RS-485 network node is core with the single-chip microcomputer, mainly comprise the system state detection node, the device power supply (DPS) Control Node, the power management node, the Electric Machine Control node, the emergency processing node, data acquisition node, serial equipment node, each network node mainly are responsible for the data acquisition and processing (DAP) of sensor, carry the control of equipment, motor-driven control, fault detect, the detection of leaking, the emergency processing task; Main frame node and all RS-485 network nodes all link together by the RS-485 interface, constitute the RS-485 network; Software is made up of main frame program and each Single Chip Microcomputer (SCM) program, wherein the main frame program comprises RS-485 network driver, each RS-485 network node driver, RS-485 user interface built-in function, and Single Chip Microcomputer (SCM) program mainly comprises system state trace routine, device power supply (DPS) control program, power management routines, Electric Machine Control program, emergency processing program, data acquisition program, serial equipment program.
2. according to robot control system under the described distributed water of claim 1, it is characterized in that: the serial ports of main frame is connected on the RS-485 network by the RS-232/RS-485 converter, by the single chip communication of RS-485 network and each RS-485 network node, the microcontroller serial port of each RS-485 network node is connected on the RS-485 network by the RS-485 chip for driving.
3. according to robot control system under the described distributed water of claim 1, it is characterized in that: described RS-485 network driver is responsible for driving the RS-232/RS-485 converter, adopts information communication method to realize the exchanges data of RS-485 network node driver and each single-chip microcomputer node procedure; Idiographic flow is: accreditation process name at first after the startup, the time that is provided with interrupts and serial ports interrupts, program enters the circular wait state then, if timing arrives, the generation time message of interrupting then, program judges whether successfully received data last time, if a certain task successful then in 1～task n is executed the task in the execution distribution, current task promptly is set for to carry out message exchange with a certain driver, then calculation check and and send serial data to the RS-485 network, the transmission program that finishes is in the circular wait message status, if receive serial data then produce the serial ports interrupt message, if Data Receiving success and correct then data are sent to the driver of this node; If timing does not then receive the correct data of certain node yet, then recommunicate, as still not receiving correct data, then think this node failure, and fault is sent to this node driver by message exchange; Task 1～task n in the program is a task list, and program decides what task of execution according to a counter from 1 to n, promptly communicates with certain node, and this task list can be formulated according to the difference sampling frequency requirement to different nodes.
4. according to robot control system under the described distributed water of claim 1, it is characterized in that: described RS-485 network node driver comprises drivers such as system state detection node, device power supply (DPS) Control Node, power management node, Electric Machine Control node, emergency processing node, data acquisition node, serial equipment node, each driver is responsible for realizing the control to this node device, and the structure of each network node driver is identical; Idiographic flow enters in the circulation that waits for the arrival of news then for accreditation process name at first after starting; If receive the message of RS-485 driver, then carry out exchanges data with the RS-485 driver; If receive the message that the user interface storehouse sends, then judge task type according to the content of message; Task has two types: reading of data order and the order of control output data, if reading of data order, program just is treated to quantities to corresponding data, if control output data order, just the data that receive from the user interface storehouse are handled and are stored in the internal memory, send to the RS-485 network node during by the time with RS-485 driver swap data; After executing above-mentioned task, program and interface library function swap data send to the user interface built-in function to the data and the failure code that obtain.
5. according to robot control system under the described distributed water of claim 1, it is characterized in that: the Single Chip Microcomputer (SCM) program of described RS-485 network node node is communicated by letter with computer node by the RS-485 network, order according to main frame is moved, and sends the data to computer node; The Single Chip Microcomputer (SCM) program idiographic flow of each RS-485 network node is: carry out initialization during program run earlier, wait for that then serial ports interrupts, in serial ports interrupted, program received the data of RS-485 network and carries out according to the order that receives, and sends data to the RS-485 network; In timer interrupted, program was carried out tasks such as data acquisition, control output, calculating, data storage simultaneously according to the needs of different nodes.
6. according to robot control system under the described distributed water of claim 1, it is characterized in that: the upper strata Control Software that described RS-485 user interface built-in function adopts the file destination form to offer user's establishment is called, and realizes visit to each RS-485 network node driver data by information communication method and shared drive method.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CNB2003101052005A CN100362496C (en) | 2003-11-26 | 2003-11-26 | Distributed underwater robot control method |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CNB2003101052005A CN100362496C (en) | 2003-11-26 | 2003-11-26 | Distributed underwater robot control method |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN1622062A true CN1622062A (en) | 2005-06-01 |
| CN100362496C CN100362496C (en) | 2008-01-16 |
Family
ID=34757210
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CNB2003101052005A Expired - Fee Related CN100362496C (en) | 2003-11-26 | 2003-11-26 | Distributed underwater robot control method |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN100362496C (en) |
Cited By (13)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102539182A (en) * | 2011-12-14 | 2012-07-04 | 上海海事大学 | Autonomous remotely-operated vehicle (ARV) fault diagnosis principal component analysis device |
| CN103345257A (en) * | 2013-06-29 | 2013-10-09 | 西北工业大学 | Autopilot control system of underwater vehicle |
| CN103439935A (en) * | 2013-08-15 | 2013-12-11 | 青岛远创机器人自动化有限公司 | Underwater robot control system based on state machine model |
| CN104678931A (en) * | 2013-11-30 | 2015-06-03 | 中国科学院沈阳自动化研究所 | Intelligent battery pack detection and control device and intelligent battery pack detection and control method for underwater robot |
| CN104932454A (en) * | 2015-04-27 | 2015-09-23 | 哈尔滨工程大学 | ROV remote communication system |
| CN105711786A (en) * | 2016-01-26 | 2016-06-29 | 河北工业大学 | Miniature modular AUV tail arrangement structure |
| CN106126346A (en) * | 2016-07-05 | 2016-11-16 | 东北大学 | A kind of large-scale distributed data collecting system and method |
| CN108037763A (en) * | 2017-12-15 | 2018-05-15 | 中国南方电网有限责任公司调峰调频发电公司 | Underwater robot control device |
| CN109484591A (en) * | 2018-11-15 | 2019-03-19 | 江苏科技大学 | A kind of underwater robot propeller modular event driven circuit and its driving method |
| CN110968084A (en) * | 2018-09-30 | 2020-04-07 | 中国科学院沈阳自动化研究所 | Man-machine sharing control method for autonomous remote control underwater robot |
| CN111290343A (en) * | 2018-12-07 | 2020-06-16 | 中国科学院沈阳自动化研究所 | Bus type electric control system and method in underwater robot cabin |
| CN111497964A (en) * | 2020-04-27 | 2020-08-07 | 山东大学 | Distributed control system of electrically-driven quadruped robot |
| CN112859887A (en) * | 2019-11-28 | 2021-05-28 | 中国科学院沈阳自动化研究所 | Multi-underwater robot autonomous task allocation method based on space-based center |
Family Cites Families (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH0746677A (en) * | 1993-07-27 | 1995-02-14 | Toyo Techno Corp:Kk | Distributed processing unification control system |
| US6421570B1 (en) * | 1997-08-22 | 2002-07-16 | Honeywell Inc. | Systems and methods for accessing data using a cyclic publish/subscribe scheme with report by exception |
| JP2003334783A (en) * | 2002-05-13 | 2003-11-25 | Canon Inc | Robot information control method |
-
2003
- 2003-11-26 CN CNB2003101052005A patent/CN100362496C/en not_active Expired - Fee Related
Cited By (19)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102539182A (en) * | 2011-12-14 | 2012-07-04 | 上海海事大学 | Autonomous remotely-operated vehicle (ARV) fault diagnosis principal component analysis device |
| CN103345257A (en) * | 2013-06-29 | 2013-10-09 | 西北工业大学 | Autopilot control system of underwater vehicle |
| CN103439935A (en) * | 2013-08-15 | 2013-12-11 | 青岛远创机器人自动化有限公司 | Underwater robot control system based on state machine model |
| CN103439935B (en) * | 2013-08-15 | 2015-12-02 | 青岛远创机器人自动化有限公司 | A kind of underwater robot control system based on state machine model |
| CN104678931B (en) * | 2013-11-30 | 2017-06-30 | 中国科学院沈阳自动化研究所 | A kind of underwater robot intelligent battery group Detection ＆ Controling devices and methods therefor |
| CN104678931A (en) * | 2013-11-30 | 2015-06-03 | 中国科学院沈阳自动化研究所 | Intelligent battery pack detection and control device and intelligent battery pack detection and control method for underwater robot |
| CN104932454A (en) * | 2015-04-27 | 2015-09-23 | 哈尔滨工程大学 | ROV remote communication system |
| CN104932454B (en) * | 2015-04-27 | 2017-12-19 | 哈尔滨工程大学 | A kind of ROV telecommunication systems |
| CN105711786A (en) * | 2016-01-26 | 2016-06-29 | 河北工业大学 | Miniature modular AUV tail arrangement structure |
| CN105711786B (en) * | 2016-01-26 | 2019-09-03 | 河北工业大学 | A kind of tail portion micromodule AUV arragement construction |
| CN106126346A (en) * | 2016-07-05 | 2016-11-16 | 东北大学 | A kind of large-scale distributed data collecting system and method |
| CN106126346B (en) * | 2016-07-05 | 2019-02-26 | 东北大学 | A kind of large-scale distributed data collection system and method |
| CN108037763A (en) * | 2017-12-15 | 2018-05-15 | 中国南方电网有限责任公司调峰调频发电公司 | Underwater robot control device |
| CN110968084A (en) * | 2018-09-30 | 2020-04-07 | 中国科学院沈阳自动化研究所 | Man-machine sharing control method for autonomous remote control underwater robot |
| CN109484591A (en) * | 2018-11-15 | 2019-03-19 | 江苏科技大学 | A kind of underwater robot propeller modular event driven circuit and its driving method |
| CN111290343A (en) * | 2018-12-07 | 2020-06-16 | 中国科学院沈阳自动化研究所 | Bus type electric control system and method in underwater robot cabin |
| CN112859887A (en) * | 2019-11-28 | 2021-05-28 | 中国科学院沈阳自动化研究所 | Multi-underwater robot autonomous task allocation method based on space-based center |
| CN112859887B (en) * | 2019-11-28 | 2022-06-14 | 中国科学院沈阳自动化研究所 | Multi-underwater robot autonomous task allocation method based on space-based center |
| CN111497964A (en) * | 2020-04-27 | 2020-08-07 | 山东大学 | Distributed control system of electrically-driven quadruped robot |
Also Published As
| Publication number | Publication date |
|---|---|
| CN100362496C (en) | 2008-01-16 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN1622062A (en) | Distributed underwater robot control system | |
| CN1319701C (en) | Underwater robot control device adopting distributed node network | |
| CN2660592Y (en) | Distributed underwater robot control device | |
| CN101045299A (en) | Independent joint control device for modularized robot based on DSP | |
| CN2675357Y (en) | Distributed underwater robot control device | |
| CN108881245B (en) | Unmanned ship control transmission system and control transmission method based on double master controls and power management | |
| CN103324207A (en) | Cluster solar energy tracking control system | |
| CN201118372Y (en) | Bus intelligent electromotor | |
| CN201004175Y (en) | Field bus multi-sensor fusion device | |
| CN104932385A (en) | Multi-axis control system and method for wave simulation | |
| CN1278884C (en) | Electronic control unit acceptable for fuel cell power assembly control | |
| CN1655080A (en) | Arm rack motion controller of concrete pump truck | |
| CN101872167A (en) | Motor control device of amphibious robot | |
| CN201363198Y (en) | Electronic throttle controller of engine | |
| CN201060394Y (en) | Controller device for high voltage frequency converter | |
| CN211928433U (en) | Distributed network control device | |
| CN101236421B (en) | On site bus multi- sensor amalgamation device | |
| CN2938187Y (en) | Building controller based on Enthernet | |
| CN205466220U (en) | Host control system of soldering tin robot | |
| CN112083701A (en) | Novel fuel purifies device control system | |
| CN220154809U (en) | Distributed collaborative intelligent control system | |
| CN2861969Y (en) | Position control device for auto-guiding vehicle | |
| CN217955918U (en) | Fuel cell | |
| CN217606354U (en) | Reconfigurable edge calculation module | |
| CN211403224U (en) | Intelligent thermal power generating unit control platform structure with octopus-shaped structure |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| C14 | Grant of patent or utility model | ||
| GR01 | Patent grant | ||
| C19 | Lapse of patent right due to non-payment of the annual fee | ||
| CF01 | Termination of patent right due to non-payment of annual fee |