CN107193281A - A kind of intelligent vehicle-carried label A GV control systems and its control method - Google Patents
A kind of intelligent vehicle-carried label A GV control systems and its control method Download PDFInfo
- Publication number
- CN107193281A CN107193281A CN201710407458.2A CN201710407458A CN107193281A CN 107193281 A CN107193281 A CN 107193281A CN 201710407458 A CN201710407458 A CN 201710407458A CN 107193281 A CN107193281 A CN 107193281A
- Authority
- CN
- China
- Prior art keywords
- dolly
- module
- control
- fuzzy
- label
- 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
- 238000000034 method Methods 0.000 title claims abstract description 29
- 230000011664 signaling Effects 0.000 claims abstract description 19
- 238000011002 quantification Methods 0.000 claims description 15
- 230000007613 environmental effect Effects 0.000 claims description 12
- 230000005540 biological transmission Effects 0.000 claims description 6
- 230000005670 electromagnetic radiation Effects 0.000 claims description 6
- 230000000052 comparative effect Effects 0.000 claims description 3
- 230000000149 penetrating effect Effects 0.000 claims 1
- 230000007935 neutral effect Effects 0.000 description 6
- 230000004888 barrier function Effects 0.000 description 5
- 238000005516 engineering process Methods 0.000 description 5
- 230000008901 benefit Effects 0.000 description 4
- 238000010586 diagram Methods 0.000 description 4
- 239000010410 layer Substances 0.000 description 4
- 238000011161 development Methods 0.000 description 3
- 238000012544 monitoring process Methods 0.000 description 3
- 230000008569 process Effects 0.000 description 3
- 238000012546 transfer Methods 0.000 description 3
- 238000013528 artificial neural network Methods 0.000 description 2
- 238000004891 communication Methods 0.000 description 2
- 238000013461 design Methods 0.000 description 2
- 230000036039 immunity Effects 0.000 description 2
- 230000002779 inactivation Effects 0.000 description 2
- 230000010354 integration Effects 0.000 description 2
- 230000004807 localization Effects 0.000 description 2
- 230000033001 locomotion Effects 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000000284 resting effect Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000011143 downstream manufacturing Methods 0.000 description 1
- 235000013399 edible fruits Nutrition 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000005611 electricity Effects 0.000 description 1
- 238000005538 encapsulation Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 238000009432 framing Methods 0.000 description 1
- 239000011229 interlayer Substances 0.000 description 1
- 230000009021 linear effect Effects 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000009022 nonlinear effect Effects 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 230000000630 rising effect Effects 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 230000009897 systematic effect Effects 0.000 description 1
- 238000011144 upstream manufacturing Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0242—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using non-visible light signals, e.g. IR or UV signals
-
- 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
- G05B11/00—Automatic controllers
- G05B11/01—Automatic controllers electric
- G05B11/36—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential
- G05B11/42—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential for obtaining a characteristic which is both proportional and time-dependent, e.g. P. I., P. I. D.
-
- 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
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
- G05D1/028—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using a RF signal
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Electromagnetism (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Software Systems (AREA)
- Medical Informatics (AREA)
- Evolutionary Computation (AREA)
- Artificial Intelligence (AREA)
- Health & Medical Sciences (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
The invention discloses a kind of intelligent vehicle-carried label A GV control systems and its control method, including:Motor is respectively mounted on dolly, its trailing wheel;RFID tag, it is fixed on dolly, the position signalling for sending dolly;Positioner, it receives the position signalling of dolly and dolly position signalling is read out and positioned, and sends location information;GPRS module, it is fixed on the dolly, for receiving location information;Vehicle driving module, it is fixed on dolly and connects motor, the rotating speed for controlling motor;Master controller, it connects GPRS module, receives the location information of the dolly of GPRS module and is compared the coordinate of the location information of dolly and target location;Wherein, the master controller also includes pwm signal control driver element, and its connection body drive module passes through the rotating speed that vehicle driving module controls motor.The AGV control systems and its control method of the present invention can accurately control the track that dolly is moved to target, reduce deviation.
Description
Technical field
The present invention relates to automated guided vehicle field.It is more particularly related to intelligent vehicle-carried label A GV controls system
System and control method field.
Background technology
With the development of information integration of enterprise, AGV automated transport systems are used as materials stream informationization, the important hand of automation
Section, is used widely.Traditional shop logistics transport is most of to be made up of conveyer belt, hutching etc., and one side logistics is defeated
Sending can not be connected well between inefficiency, upstream and downstream process;On the other hand, with the rising of the price of labour power, existing system
System human cost is sharply increased.The limitation of traditional workshop logistics transportation is then not present in AGV automated transport systems, realizes logistics
Informationization, acts on huge in terms of IT application in enterprise, reduction human cost, the raising performance of enterprises.
With the development of technology of Internet of things, closely the technical need of indoor wireless positioning is more and more.Conventional positioning
Technology mainly includes GPS, infrared, bluetooth, wifi, RFID etc..Because gps signal can not penetrate building and civilian positioning mistake
Difference is required within 10 meters, therefore is not suitable for indoor positioning.
Although infrared location technology can reach the high precision of comparison, barrier can not be penetrated, can only be in horizon range
It is interior to use and limited by directionality, it is also not suitable for indoor positioning.There is noncontact due to RFID localization methods, it is non line of sight, anti-dry
The advantages of immunity is strong, is widely used in positioning indoors.RFID general principle is the biography reflected using radiofrequency signal
Defeated characteristic, realizes the identification to object.In current research, based on RSSI (Received Signal Strength
Indication) general principle of technological orientation is the signal intensity for collecting wireless signal in communication environments, is passed according to signal
Attenuation model is broadcast to estimate target location.The technology is because the advantage such as cost is low, less investment, equipment are simple, as in RFID rooms
The method for optimizing of positioning.
It is traditional that based in reference label localization method, increase reference label can produce the non-linear factors such as Radio frequency interference,
So as to reduce positioning precision.Compared with traditional algorithm, patent of the present invention proposes a kind of based on BP artificial neural networks and with reference to mark
The vahicles label AGV control systems of label, introduce BP artificial neural networks processing non-linear effects, utilize real-time scene parameter configuration
Running parameter, improves Positioning System and robustness, reduces cost.
The content of the invention
It is an object of the present invention to provide a kind of intelligent vehicle-carried label A GV control systems, control device is by actual coordinate and target
The coordinate difference of coordinate is converted to pwm signal and reaches vehicle driving module, and driving dolly advances according to predetermined path of movement.
It is a still further object of the present invention to provide a kind of control method of intelligent vehicle-carried label A GV control systems, mould is utilized
Paste PID control method is compensated to traveling deviation of the dolly into traveling target, improves the accuracy of carriage walking.
Controlled to realize according to object of the present invention and further advantage there is provided a kind of intelligent vehicle-carried label A GV
System, including:
Motor is respectively mounted on dolly, its trailing wheel;
RFID tag, it is fixed on dolly, the position signalling for sending dolly;
Positioner, it receives the position signalling of dolly and dolly position signalling is read out and positioned, and sends fixed
Position information;
GPRS module, it is fixed on the dolly, for receiving location information;
Vehicle driving module, it is fixed on dolly and connects motor, the rotating speed for controlling motor;And
Master controller, it connects GPRS module by RS485 interfaces, receives the location information of the dolly of GPRS module, and
The coordinate of the location information of dolly and target location is compared;
Wherein, the master controller also includes pwm signal control driver element, and the pwm signal control driver element connects
Vehicle driving module is connect, it exports PWM duty cycle signal according to coordinate comparative result, pass through vehicle driving module control driving electricity
The rotating speed of machine.
Preferably, in addition to:Infrared obstacle avoidance module, it is arranged on the surrounding of dolly, for detecting dolly surrounding obstacle
And export halt signal;
Wherein, the infrared obstacle avoidance module is also connected with master controller, and master controller receives halt signal, and control dolly is temporary
Stop.
Preferably, in addition to:Power module, it connects master controller, radio-frequency module, GPRS module, infrared obstacle avoidance mould
Block and vehicle driving module, for providing master controller, radio-frequency module, GPRS module, infrared obstacle avoidance module and car body driving mould
The operating voltage of block.
Preferably, the positioner includes:
Multiple RFID readers, it fixes multiple corners indoors, for receiving the position signalling that RFID tag is sent;
Router, it connects the RFID reader by RJ45 interfaces, for transmission location signal;
Server, it connects the router, for transmission location signal.
Preferably, the positioner also includes:
Sensor group, it is arranged on the side of the RFID reader, the environmental information for detecting RFID reader;
Controlled in sensor, it connects sensor group and router respectively, for environmental information to be transmitted to server.
Preferably, the sensor group includes temperature sensor, humidity sensor, luminance sensor and electromagnetic radiation biography
Sensor.
The purpose of the present invention also realized by a kind of control method of intelligent vehicle-carried label A GV control systems, including with
Lower step:
Step 1, target position information (X, Y) inputted into master controller, and reads the location information of RFID tag on dolly,
Export target travel track;
Step 2, travel track resolves into n sections, then m tracing point is resolved into by every sections of n sections of kinds;
Step 3, march to i-th section of kth when dollyi,jDuring tracing point, its target location coordinateWith reality
Coordinate position (Xi,j、Yi,j) be compared, the PWM of trolley drive motor dutycycle is carried out using fuzzy PID control method
Compensation, so as to kthi,jTracing point is corrected, so as to control two driving wheels of AGV to run to target location.
Preferably, the fuzzy PID control method includes:
Fuzzy controller inputs the deviation e of abscissaij(x), ordinate deviation eij(y), output PID proportionality coefficient, ratio
Example integral coefficient and differential coefficient, proportionality coefficient, proportion integral modulus and differential coefficient input PID controller carry out accounting for for PWM
Sky is than compensation control.
Preferably, abscissa deviation e in the fuzzy controllerij(x) with ordinate deviation eij(y) it is divided into 7 etc.
Level;Proportionality coefficient, proportion integral modulus and the differential coefficient of the output PID is divided into 7 grades;
The fuzzy set of input and the output of the fuzzy controller is { NB, NM, NS, 0, PS, PM, PB }.
Preferably, the abscissa deviation eij(x) fuzzy domain is [- 0.04,0.04], and the quantification factor is 1;Institute
State ordinate deviation eij(y) fuzzy domain is [- 0.04,0.04], and the quantification factor is 1;
The fuzzy domain of the proportionality coefficient of the output PID is [- 1,1], and its quantification factor is 0.1;Proportional integration system
Several fuzzy domains is [- 1,1], and its quantification factor is 0.158;The fuzzy domain of differential coefficient is [- 1,1], its quantification
The factor is 0.0003;
The abscissa deviation eij(x) with ordinate deviation eij(y) membership function is trigonometric function;
The membership function of the proportionality coefficient of the PID, proportion integral modulus and differential coefficient is trigonometric function.
The present invention at least includes following beneficial effect:Realize that a set of tag system can train multiple virtual coordinates scenes,
Multiple similar places can use same virtual scene, so as to greatly reduce the expense that AGV field tags are used and label is changed
With the problem of solving poor anti jamming capability in RFID tag use.
Further advantage, target and the feature of the present invention embodies part by following explanation, and part will also be by this
The research and practice of invention and be understood by the person skilled in the art.
Brief description of the drawings
Fig. 1 is the AGV control device schematic diagrames in the intelligent vehicle-carried label A GV control systems of the present invention.
Fig. 2 is the positioner schematic diagram in the intelligent vehicle-carried label A GV control systems of the present invention.
Fig. 3 is the positioner of the present invention based on BP and Landmarc algorithm flow charts.
Fig. 4 is the control flow chart of the AGV control devices of the positioner of the present invention.
Fig. 5 is the track and target travel track comparison diagram that the AGV dollies of the present invention are walked to target location.
Fig. 6 is the fuzzy-adaptation PID control schematic diagram of the present invention.
Fig. 7 is the input abscissa deviation e of the fuzzy controller of the present inventionij(x) triangle membership function figure.
Fig. 8 is the input ordinate deviation e of the fuzzy controller of the present inventionij(y) triangle membership function figure.
Fig. 9 is the triangle membership function figure of the output PID of the fuzzy controller of present invention proportionality coefficient.
Figure 10 is the triangle membership function figure of the output PID of the fuzzy controller of present invention proportion integral modulus.
Figure 11 is the triangle membership function figure of the output PID of the fuzzy controller of present invention differential coefficient.
Embodiment
The present invention is described in further detail below in conjunction with the accompanying drawings, to make those skilled in the art with reference to specification text
Word can be implemented according to this.
It should be appreciated that such as " having ", "comprising" and " comprising " term used herein do not allot one or many
The presence or addition of individual other elements or its combination.
Fig. 1-2 shows a kind of way of realization according to the present invention, and intelligent vehicle-carried label A GV control systems include:Dolly
22nd, RFID tag 28, positioner and AGV car controllers.
Motor is respectively mounted on the trailing wheel of dolly 22, for driving dolly 22 to walk;
RFID tag 28 is fixed on dolly 22, and the position signalling for sending dolly 22, RFID tag 28 is used
CC2520 chips, driving function will complete CC2520 initialization, state-maintenance and (receive data, send data, idle pulley, sleep
Sleep mode etc.) and the function such as power managed.
Positioner lay indoors, for receive the position signalling of dolly 22 and dolly position signalling is read out and
Positioning, and send location information.
As shown in Fig. 2 AGV car controllers include master controller 30, GPRS module 36 and car body driver element 39, its
In, master controller 30 uses ARM-STM32F103VET6 chips, passes through Keil development environment edit operations system, respective drive
With the program such as position coordinates algorithm, reuse the link block burning program of jtag interface 31 and enter hardware, the master controller 30
Driver element 40 is controlled including SPI interface 33, RS485 interfaces 35 and pwm signal, master controller 30 is connected by RS485 interfaces 35
GPRS module 36 is connect, the location information of the dolly 22 of GPRS module 36 is received;Master controller 30 connects RFID by SPI interface 33
Label 28;Master controller 30 controls the connection body drive module 39 of driver element 40 by pwm signal, by PWM duty cycle signal
Transmit to vehicle driving module 39.
GPRS module 36 is fixed on the dolly 22, the location information sent for receiving positioner, GPRS module
36 control it to be established the link with server by ARM-STM32F103VET6, and provide RS232 interfaces, and serial ports uses 115200
Baud rate, and GPRS module 36 supports outside SIM card, is directly connected with 3.0vSIM cards or 1.8vSIM cards, module is supervised automatically
Survey and adapt to the type of SIM card.
Vehicle driving module 39 is fixed on dolly 22 and connects motor, the rotating speed for controlling motor, its
The L298N driving chips produced using STMicw Electronics's body design motor drive module, and L298N driving voltages highest supports 46V,
Maximum output DC current reaches 4A, the function with overtemperature protection and overcurrent protection, and control signal low level is 0~1.5V width
Noise immunity, complies fully with the design requirement of electric-motor drive unit.
In the process of walking, RFID tag 28 thereon sends the position signalling of dolly 22 to dolly 22, and positioner is received
The position signalling of dolly 22 is simultaneously read out and positioned to dolly position signalling, and sends location information.Master controller 30 is received
The coordinate of the location information of dolly and target location is simultaneously compared by the location information of dolly 22, and according to coordinate comparative result
PWM duty cycle signal is exported, the rotating speed of motor is controlled by vehicle driving module 39, so as to accurately control dolly 22 to mesh
Cursor position is advanced, it is to avoid deviate target location.
In another embodiment, the master controller 30 also includes master controller I/O control modules 37, the AGV dollies
Control device also includes infrared obstacle avoidance module 38, and it uses domestic rich light E18-D150NK infrared external reflections avoidance sensor, small
An E18-D150NK infrared external reflection avoidance sensor is respectively installed at left, center, right position before car 22, by the sensing of middle part
Device detecting distance is arranged on 150cm, and the sensor detecting distance at left and right position is arranged on 50cm, thus can be by these three
Sensor group is combined the sensor for constituting and possessing two-stage zone of alarm function, realizes that different alarms ring in different zone of alarm
Should.Infrared obstacle avoidance module 38 connects master controller 30 by master controller I/O control modules 37, for detecting that the surrounding of dolly 22 hinders
Hinder and export halt signal, master controller 30 receives halt signal, control dolly 22 suspends.
In another embodiment, master controller 30 also includes power module 32, and the power module 32 passes through master controller
30 provide operating voltage to GPRS module 36, infrared obstacle avoidance module 38 and vehicle driving module 39.
In another embodiment, the RFID tag 28 also includes radio-frequency module 34, and the driver of radio-frequency module 34 is completed
Encapsulation to all basic functions of CC2520 chips.All operations to CC2520, can by this Driver function library come
Complete.CC2520 working conditions transfer logic is also maintained inside other function library, it is ensured that chip can be operated in correct receipts
In hair pattern.
In another embodiment, as shown in figure 1, the positioner includes:RFID reader 1, RFID reader 2,
RFID reader 3, RFID reader 4, router 25,27,4 read write lines of server fix multiple corners indoors, are used for
Receive the position signalling (i.e. RSSI data) that RFID tag 28 is sent;Router 25 connects the RFID by RJ45 interfaces 26 and read
Device 1, RFID reader 2, RFID reader 3 and RFID reader 4 are write, for transmission location signal;Server 27 connects described
Router 25, for transmission location signal.Wherein, install as shown in Figure 3 based on BP and Landmarc algorithms in server 27
Indoor positioning software and program, neutral net is instructed using four read write lines and multiple fixed reference RFID tags 21
Practice, obtain the weights and parameter of each interlayer mapping of neutral net, then multiple fixed reference RFID are read by four read write lines 110
The RSSI data of label 21, after server 27 is handled RSSI data using neutral net, export multiple fixed references
The elements of a fix of RFID tag 21, the coordinate setting degree of accuracy is greatly improved, the indoor positioning based on BP and Landmarc algorithms
Program is disclosed in 201710050791.2.
When needing positioning, RFID tag 28 is sent into position signalling, the receiving position signal of server 27 utilizes what is trained
After neutral net is handled RSSI data, the location information of RFID tag 28 is obtained, and positioning is transmitted by router 25
Information.
In another embodiment, the positioner also includes control 23 and sensor group in sensor, wherein, sensor group
Installed in the side of RFID reader 1, RFID reader 2, RFID reader 3 and RFID reader 4, for detecting RFID read-write
The environmental information of device;Control 23 connects sensor group and router 25 respectively in sensor, for environmental information to be transmitted to service
Device 27, sensor group transmits environmental information to router 25 by controlling 23 in sensor, and environmental information is transmitted to server
27, environmental information is identified the program of the indoor positioning based on BP and Landmarc algorithms in server 27, so as to calculating
The parameter of method is corrected, it is to avoid parameter drift caused by environmental change, the error caused by, improves the precision of positioning.
In another embodiment, the sensor group includes temperature sensor 5, temperature sensor 6, temperature sensor 7, temperature
Spend sensor 8, it is humidity sensor 9, humidity sensor 10, humidity sensor 11, humidity sensor 12, luminance sensor 13, bright
Spend sensor 14, luminance sensor 15, luminance sensor 16, electromagnetic radiation sensor 17, electromagnetic radiation sensor 18, electromagnetism spoke
Sensor 19, electromagnetic radiation sensor 20 are penetrated, sensor group detects temperature, the humidity around RFID reader respectively.Brightness and
The environmental informations such as electromagnetic radiation, it is to avoid error caused by environmental factor, improve the precision of positioning.
The present invention also protects a kind of control method of intelligent vehicle-carried label A GV control systems, as shown in figure 4, including following
Step:
Step 1, system initialization, generate the parameter based on BP and Landmarc algorithms:
Before the motion of AGV dollies 22, positioner generates virtual label map first:Several are put in intended site
Fixed reference RFID tag 21, server system initialization, reads sensor group data, generates scenario parameters.Read by RFID
Write device 1, RFID reader 2, RFID reader 3, RFID reader 4, read fixed reference RFID tag 21 RSSI value and its
Corresponding coordinate.BP_Landmarc neutral nets are trained, the connection weight of input layer and each node of hidden layer is obtained,
The connection weight of hidden layer and each node of output layer, preserves BP_Landmarc neutral nets running parameter and scenario parameters.
Step 2, the corresponding position coordinateses of target position information A (X, Y) are inputted into master controller, and read RFID on dolly
The curve that travel track is represented with symbol " ※ " in the location information of label 28, output target travel track, i.e. Fig. 5.
After the distribution map drafting of positioning RFID tag is finished, as shown in figure 4, AGV controls circuitry software system start-up initialisation,
First determine whether nearby whether there is barrier, if barrier, wait barrier to remove, if without barrier, system and clothes
Business device is communicated.In system control dolly moving process, the acquisition of dolly positional information is marked by RFID reader and RFID
The work of label 28 is realized.
The work detailed process of RFID tag 28 is as follows:Shape is intercepted when initialization completes to enter after either label is waken up
State, tag system uses timer internal from wake-up mechanism, was produced every about 1 second time and once wakes up Interruption letter
Number.Label into state of intercepting opens RF transmit-receive circuit, intercepts reader ready command.If in stipulated time (T1=
Effective ready command could not be received in 1.5ms) and then come back to resting state.When the label in state of intercepting is received effectively
Ready command's frame when, tag state is just intercepted and is converted to ready state.Label in ready state is receiving access frame
Enter arbitration state after initial order;Enter words shape of attending the meeting after receiving the session phase orders such as file access command, monitoring order
State;Resting state is transferred to again if effective order frame is not received in stipulated time T2.Enter the label of arbitration state
The initial of reader is waited to take inventory to obtain TID.Label in ready state receive access frame initial order after enter it is secondary
Sanction state, the label of arbitration state is collided with framing binary tree collision algorithm together with the label of other entrance arbitration states to be connect
Enter.Collection status can be transferred to after label receives in arbitration state and is successfully accessed order, if not complete in arbitration state
Into collision access procedure either because overtime (T3) then comes back to ready state.If in arbitration state label and its
Access slot number is successfully assigned to after the access of its label anti-collision, then label is collection status from State Transferring is arbitrated, in receipts
The label of collection state waits reader to initiate to collect order.Arbitration phase label be assigned to simply collect when need when
Gap, reader does not get the TID of label now.In collection status, label is in the time slot oneself being assigned to oneself
The essential information such as TID send reader to.If waiting overtime (T4) in collection status, or receive the collection of reader
Failure order is then ready state by collection status transfer.Label after collecting successfully is transferred to session status.In session shape
The label of state can handle the not high command request of reader security requirement, and such as file system access order, monitoring cycle are ordered
Order etc..If the label in session status receives solid identification order, secured session state is transferred to after differentiating successfully.Such as
Fruit (T5) in defined time-out time does not receive wide and efficient reading device command frame, then state comes back to ready state.Place
Encrypted content transfer is used when the label of secured session state carries out point-to-point communication with reader, with very high guarantor
Close property.Label in secured session state can perform file access command, monitoring order, security protocol order, renewal system
The orders such as password etc. of uniting is ordered, inactivation label.Label in secured session state is received after inactivation tag command, erasing storage
Inactivated state is transferred on device after all the elements.The label of inactivated state no longer responds any order of reader.If defined
Effective secured session phase order is not received in time-out time (T6), then label turns again to ready state.
Step 3, as shown in figure 5, travel track is resolved into n sections by travel track, then every section in n sections is resolved into m
Tracing point;
Step 4, march to i-th section of kth when dollyi,jDuring tracing point, its target location coordinateWith reality
Coordinate position (Xi,j、Yi,j) be compared, the PWM of trolley drive motor dutycycle is carried out using fuzzy PID control method
Compensation, so as to kthi,jTracing point is corrected, so as to control two driving wheels of AGV to run to target location.
As shown in fig. 6, the fuzzy PID control method includes:Fuzzy controller and PID controller are serially connected, and are obscured
Controller inputs the deviation e of abscissaij(x), ordinate deviation eij(y), output PID proportionality coefficient, proportion integral modulus and
Differential coefficient, proportionality coefficient, proportion integral modulus and differential coefficient input PID controller carry out PWM dutycycle compensation control.
By abscissa deviation eij(x), ordinate deviation eij(y), PID proportionality coefficient, proportion integral modulus and differential system
Number carries out Fuzzy Processing;When without control, the abscissa deviation eij(x) fuzzy domain is [- 0.04,0.04], quantification
The factor is 1;The ordinate deviation eij(y) fuzzy domain is [- 0.04,0.04], and the quantification factor is 1;The output PID
Proportionality coefficient fuzzy domain be [- 1,1], its quantification factor be 0.1;The fuzzy domain of proportion integral modulus for [- 1,
1], its quantification factor is 0.158;The fuzzy domain of differential coefficient is [- 1,1], and its quantification factor is 0.0003;In order to protect
The precision of control is demonstrate,proved, preferably control is realized, experiment is repeated, it is determined that optimal input and output level, wherein, it is described
Abscissa deviation e in fuzzy controllerij(x) with ordinate deviation eij(y) it is divided into 7 grades;The ratio system of the output PID
Number, proportion integral modulus and differential coefficient are divided into 7 grades;The fuzzy set of input and the output of the fuzzy controller is
{ NB, NM, NS, 0, PS, PM, PB }.The membership function of input and output uses triangular membership, refers to Fig. 7-11.
Wherein, the fuzzy control rule of the fuzzy controller is:
1st, as abscissa deviation eij(x), ordinate deviation eij(y) when larger, K is increasedpValue so that deviation is quick
Reduce, but generate larger deviation variation rate simultaneously, less K should be takend, generally take Ki=0;
2nd, as abscissa deviation eij(x), ordinate deviation eij(y) when value is in medium, to avoid overshoot, suitably subtract
Small KpValue, make KiIt is smaller, select appropriately sized Kd;
3rd, as abscissa deviation eij(x), ordinate deviation eij(y) when smaller, K is increasedpKiValue, to avoid the occurrence of
The wild effect that systematic steady state value is oscillated about, generally makes to work as eij(x)、eij(y) when larger, less K is takend;Work as eij(x)、
eij(y) when smaller, larger K is takend;Specific fuzzy control rule refers to table one, two and three.
The PID of table one Proportional coefficient KpFuzzy control table
The PID of table two proportion integral modulus KiFuzzy control table
The PID of table three differential coefficient KdFuzzy control table
Input the deviation e of abscissaij(x), ordinate deviation eij(y) PID proportionality coefficient, proportion integral modulus, is exported
And differential coefficient, proportionality coefficient, proportion integral modulus and differential coefficient carry out defuzzification with height method, input PID controller
PWM dutycycle compensation control is carried out, it controls the formula to be:
The abscissa deviation eij(x) with ordinate deviation eij(y) membership function is trigonometric function;
The membership function of the proportionality coefficient of the PID, proportion integral modulus and differential coefficient is trigonometric function.
As shown in Fig. 5 with the curve of symbol " * " representative, when deviation, fuzzy controller occurs in the travel track of dolly
It is corrected, is that dolly produces the target progress track that symbol " ※ " representative is quickly returned to after deviation, as fully visible, this
The control method of the intelligent vehicle-carried label A GV control systems of invention accurately can control dolly to be advanced to target location, and go out
It is quick to carrying out correcting after now deviateing, improve the walking accuracy of dolly.
Although embodiment of the present invention is disclosed as above, it is not restricted in specification and embodiment listed
With.It can be applied to various suitable the field of the invention completely., can be easily for those skilled in the art
Realize other modification.Therefore under the universal limited without departing substantially from claim and equivalency range, the present invention is not limited
In specific details and shown here as the legend with description.
Claims (10)
1. a kind of intelligent vehicle-carried label A GV control systems, it is characterised in that including:
Motor is respectively mounted on dolly, its trailing wheel;
RFID tag, it is fixed on dolly, the position signalling for sending dolly;
Positioner, it receives the position signalling of dolly and dolly position signalling is read out and positioned, and sends positioning letter
Breath;
GPRS module, it is fixed on the dolly, for receiving location information;
Vehicle driving module, it is fixed on dolly and connects motor, the rotating speed for controlling motor;And
Master controller, it connects GPRS module by RS485 interfaces, receives the location information of the dolly of GPRS module, and will be small
The location information of car and the coordinate of target location are compared;
Wherein, the master controller also includes pwm signal control driver element, the pwm signal control driver element connection car
Body drive module, it exports PWM duty cycle signal according to coordinate comparative result, and motor is controlled by vehicle driving module
Rotating speed.
2. intelligent vehicle-carried label A GV control systems as claimed in claim 1, it is characterised in that also include:
Infrared obstacle avoidance module, it is arranged on the surrounding of dolly, for detecting dolly surrounding obstacle and exporting halt signal;
Wherein, the infrared obstacle avoidance module is also connected with master controller, and master controller receives halt signal, control dolly pause.
3. intelligent vehicle-carried label A GV control systems as claimed in claim 2, it is characterised in that also include:Power module, its
Master controller, radio-frequency module, GPRS module, infrared obstacle avoidance module and vehicle driving module are connected, for providing master controller, penetrating
Frequency module, GPRS module, the operating voltage of infrared obstacle avoidance module and vehicle driving module.
4. intelligent vehicle-carried label A GV control systems as claimed in claim 3, it is characterised in that the positioner includes:
Multiple RFID readers, it fixes multiple corners indoors, for receiving the position signalling that RFID tag is sent;
Router, it connects the RFID reader by RJ45 interfaces, for transmission location signal;
Server, it connects the router, for transmission location signal.
5. intelligent vehicle-carried label A GV control systems as claimed in claim 4, it is characterised in that the positioner also includes:
Sensor group, it is arranged on the side of the RFID reader, the environmental information for detecting RFID reader;
Controlled in sensor, it connects sensor group and router respectively, for environmental information to be transmitted to server.
6. intelligent vehicle-carried label A GV control systems as claimed in claim 5, it is characterised in that the sensor group includes temperature
Spend sensor, humidity sensor, luminance sensor and electromagnetic radiation sensor.
7. a kind of control method of intelligent vehicle-carried label A GV control systems, it is characterised in that comprise the following steps:
Step 1, by target position information X, Y input master controllers, and read the location information of RFID tag on dolly export mesh
Mark travel track;
Step 2, travel track resolves into n sections, then m tracing point is resolved into by every sections of n sections of kinds;
Step 3, march to i-th section of kth when dollyi,jDuring tracing point, its target location coordinateWith real coordinate position
Xi,j、Yi,jIt is compared, the PWM of trolley drive motor dutycycle is compensated using fuzzy PID control method, so that right
Kthi,jTracing point is corrected, so as to control two driving wheels of AGV to run to target location.
8. the control method of intelligent vehicle-carried label A GV control systems as claimed in claim 6, it is characterised in that described fuzzy
PID control method includes:
Fuzzy controller inputs deviation, the ordinate deviation of abscissa, exports PID proportionality coefficient, proportion integral modulus and micro-
Divide coefficient, proportionality coefficient, proportion integral modulus and differential coefficient input PID controller carry out PWM dutycycle compensation control.
9. the control method of intelligent vehicle-carried label A GV control systems as claimed in claim 6, it is characterised in that described fuzzy
Abscissa deviation and ordinate deviation are divided into 7 grades in controller;Proportionality coefficient, the proportion integral modulus of the output PID
It is divided into 7 grades with differential coefficient;
The fuzzy set of input and the output of the fuzzy controller is { NB, NM, NS, 0, PS, PM, PB }.
10. the control method of intelligent vehicle-carried label A GV control systems as claimed in claim 6, it is characterised in that the horizontal seat
The fuzzy domain for marking deviation is [- 0.04,0.04], and the quantification factor is 1;The fuzzy domain of the ordinate deviation for [-
0.04,0.04], the quantification factor is 1;
The fuzzy domain of the proportionality coefficient of the output PID is [- 1,1], and its quantification factor is 0.1;Proportion integral modulus
Fuzzy domain is [- 1,1], and its quantification factor is 0.158;The fuzzy domain of differential coefficient is [- 1,1], its quantification factor
For 0.0003;
The membership function of the abscissa deviation and ordinate deviation is trigonometric function;
The membership function of the proportionality coefficient of the PID, proportion integral modulus and differential coefficient is trigonometric function.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710407458.2A CN107193281A (en) | 2017-06-02 | 2017-06-02 | A kind of intelligent vehicle-carried label A GV control systems and its control method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710407458.2A CN107193281A (en) | 2017-06-02 | 2017-06-02 | A kind of intelligent vehicle-carried label A GV control systems and its control method |
Publications (1)
Publication Number | Publication Date |
---|---|
CN107193281A true CN107193281A (en) | 2017-09-22 |
Family
ID=59876879
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710407458.2A Pending CN107193281A (en) | 2017-06-02 | 2017-06-02 | A kind of intelligent vehicle-carried label A GV control systems and its control method |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107193281A (en) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108021022A (en) * | 2018-01-31 | 2018-05-11 | 吉林省农业机械研究院 | A kind of rear-tractor three-link hitch and its control method |
CN108873883A (en) * | 2018-03-13 | 2018-11-23 | 浙江工业大学 | A kind of contactless guiding device of track and its guidance method |
CN109828585A (en) * | 2019-03-04 | 2019-05-31 | 山东力创科技股份有限公司 | A kind of all-around mobile AGV control method, system and AGV |
CN109947117A (en) * | 2019-04-19 | 2019-06-28 | 辽宁工业大学 | A kind of servo synchronization control system and control method suitable for monocular vision logistics distribution trolley |
CN110398955A (en) * | 2018-04-25 | 2019-11-01 | 李国刚 | The moving method of mobile target and the method moved on highway in intelligent plant |
CN111796590A (en) * | 2019-09-24 | 2020-10-20 | 北京京东乾石科技有限公司 | Obstacle avoidance control method and device, article carrying system and readable storage medium |
Citations (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6049745A (en) * | 1997-02-10 | 2000-04-11 | Fmc Corporation | Navigation system for automatic guided vehicle |
CA2749506A1 (en) * | 2009-01-17 | 2010-07-22 | Boomerang Systems, Inc. | Automated storage system and transport vehicle |
CN102346483A (en) * | 2011-06-07 | 2012-02-08 | 南京航空航天大学 | AGV (Automatic Guided Vehicle) operation control method based on passive RFID (radio frequency identification) and aided visual |
US20130054129A1 (en) * | 2011-08-26 | 2013-02-28 | INRO Technologies Limited | Method and apparatus for using unique landmarks to locate industrial vehicles at start-up |
CN202947759U (en) * | 2012-08-24 | 2013-05-22 | 扬州大学 | Wireless environment monitoring vehicle |
SK6572Y1 (en) * | 2011-12-22 | 2013-11-04 | Ceit Sk S R O | Remote monitoring method of automatic guided vehicle and system device |
CN204347616U (en) * | 2015-01-14 | 2015-05-20 | 上海普阅信息科技有限公司 | A kind of automatical pilot transportation vehicle based on RFID technique |
CN104965509A (en) * | 2015-07-13 | 2015-10-07 | 赵烨 | Automatic navigation AGV transporting trolley |
CN105117892A (en) * | 2015-10-10 | 2015-12-02 | 广东轻工职业技术学院 | Automatic warehouse management method |
CN204945797U (en) * | 2015-09-10 | 2016-01-06 | 东莞理工学院 | Intelligent transfer robot UHF RFID location system |
CN105302139A (en) * | 2015-11-02 | 2016-02-03 | 天津阿备默机器人科技有限公司 | AGV map setting method based on walking logic |
CN105404297A (en) * | 2015-11-13 | 2016-03-16 | 深圳市步科电气有限公司 | AGV control system capable of realizing accurate parking positioning and AGV |
CN105468001A (en) * | 2015-12-31 | 2016-04-06 | 浙江同筑科技有限公司 | Insert AGV (Automatic Guided Vehicle) navigation vehicle and control method thereof |
CN105468005A (en) * | 2016-02-03 | 2016-04-06 | 天津市乐图软件科技有限公司 | Automatic trolley guiding system and method based on RFID and CCD |
CN105759825A (en) * | 2016-05-18 | 2016-07-13 | 刘学良 | Algorithm for positioning control of automatic guided vehicle (AGV) robot based on fuzzy proportion integration differentiation (PID) |
CN106382930A (en) * | 2016-08-18 | 2017-02-08 | 广东工业大学 | An indoor AGV wireless navigation method and a device therefor |
CN205972531U (en) * | 2016-08-28 | 2017-02-22 | 中车青岛四方机车车辆股份有限公司 | Freight container |
-
2017
- 2017-06-02 CN CN201710407458.2A patent/CN107193281A/en active Pending
Patent Citations (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6049745A (en) * | 1997-02-10 | 2000-04-11 | Fmc Corporation | Navigation system for automatic guided vehicle |
CA2749506A1 (en) * | 2009-01-17 | 2010-07-22 | Boomerang Systems, Inc. | Automated storage system and transport vehicle |
CN102346483A (en) * | 2011-06-07 | 2012-02-08 | 南京航空航天大学 | AGV (Automatic Guided Vehicle) operation control method based on passive RFID (radio frequency identification) and aided visual |
US20130054129A1 (en) * | 2011-08-26 | 2013-02-28 | INRO Technologies Limited | Method and apparatus for using unique landmarks to locate industrial vehicles at start-up |
SK6572Y1 (en) * | 2011-12-22 | 2013-11-04 | Ceit Sk S R O | Remote monitoring method of automatic guided vehicle and system device |
CN202947759U (en) * | 2012-08-24 | 2013-05-22 | 扬州大学 | Wireless environment monitoring vehicle |
CN204347616U (en) * | 2015-01-14 | 2015-05-20 | 上海普阅信息科技有限公司 | A kind of automatical pilot transportation vehicle based on RFID technique |
CN104965509A (en) * | 2015-07-13 | 2015-10-07 | 赵烨 | Automatic navigation AGV transporting trolley |
CN204945797U (en) * | 2015-09-10 | 2016-01-06 | 东莞理工学院 | Intelligent transfer robot UHF RFID location system |
CN105117892A (en) * | 2015-10-10 | 2015-12-02 | 广东轻工职业技术学院 | Automatic warehouse management method |
CN105302139A (en) * | 2015-11-02 | 2016-02-03 | 天津阿备默机器人科技有限公司 | AGV map setting method based on walking logic |
CN105404297A (en) * | 2015-11-13 | 2016-03-16 | 深圳市步科电气有限公司 | AGV control system capable of realizing accurate parking positioning and AGV |
CN105468001A (en) * | 2015-12-31 | 2016-04-06 | 浙江同筑科技有限公司 | Insert AGV (Automatic Guided Vehicle) navigation vehicle and control method thereof |
CN105468005A (en) * | 2016-02-03 | 2016-04-06 | 天津市乐图软件科技有限公司 | Automatic trolley guiding system and method based on RFID and CCD |
CN105759825A (en) * | 2016-05-18 | 2016-07-13 | 刘学良 | Algorithm for positioning control of automatic guided vehicle (AGV) robot based on fuzzy proportion integration differentiation (PID) |
CN106382930A (en) * | 2016-08-18 | 2017-02-08 | 广东工业大学 | An indoor AGV wireless navigation method and a device therefor |
CN205972531U (en) * | 2016-08-28 | 2017-02-22 | 中车青岛四方机车车辆股份有限公司 | Freight container |
Non-Patent Citations (1)
Title |
---|
孙凌: "AGV远程控制系统设计与实现", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108021022A (en) * | 2018-01-31 | 2018-05-11 | 吉林省农业机械研究院 | A kind of rear-tractor three-link hitch and its control method |
CN108021022B (en) * | 2018-01-31 | 2024-02-20 | 吉林省农业机械研究院 | Rear-mounted three-point suspension device of tractor and control method thereof |
CN108873883A (en) * | 2018-03-13 | 2018-11-23 | 浙江工业大学 | A kind of contactless guiding device of track and its guidance method |
CN110398955A (en) * | 2018-04-25 | 2019-11-01 | 李国刚 | The moving method of mobile target and the method moved on highway in intelligent plant |
CN109828585A (en) * | 2019-03-04 | 2019-05-31 | 山东力创科技股份有限公司 | A kind of all-around mobile AGV control method, system and AGV |
CN109947117A (en) * | 2019-04-19 | 2019-06-28 | 辽宁工业大学 | A kind of servo synchronization control system and control method suitable for monocular vision logistics distribution trolley |
CN111796590A (en) * | 2019-09-24 | 2020-10-20 | 北京京东乾石科技有限公司 | Obstacle avoidance control method and device, article carrying system and readable storage medium |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107193281A (en) | A kind of intelligent vehicle-carried label A GV control systems and its control method | |
CN106557791B (en) | A kind of supermarket shopping management system and its method | |
CN104914869B (en) | Discrete Production Workshop material distributing trolley control system based on UWB | |
CN102682620B (en) | The perception of container hargour travel condition of vehicle and positioning system and method | |
CN105869319A (en) | Supervision system and supervision method for preventing movement of POS machine | |
CN104950887A (en) | Transportation device based on robot vision system and independent tracking system | |
CN104537829A (en) | Intelligent car and positioning method used for intelligent transportation physical simulation platform | |
CN106873605A (en) | A kind of regulator control system for carrying automatical pilot transportation vehicle and regulation and control method | |
CN110450176A (en) | The robot to make an inventory for Power Material storage | |
CN106441306A (en) | Intelligent life detecting robot with capabilities of independent positioning and map building | |
CN206209744U (en) | A kind of articles from the storeroom identifying system based on mobile robot control | |
CN206232331U (en) | For the intelligent to Barebone of container | |
CN107728620A (en) | A kind of Unmanned Systems of new-energy automobile and method | |
CN109034702A (en) | A kind of unmanned hardware building materials fortune of wisdom formula sells vehicle, shared system and business model | |
CN105929826B (en) | Feeding robot and its accurate positioning method based on indoor electronic map | |
Xu et al. | Path Planning for Autonomous Articulated Vehicle Based on Improved Goal‐Directed Rapid‐Exploring Random Tree | |
CN206096930U (en) | Friehgt dolly | |
CN207241188U (en) | It is a kind of can automatic tracking Intelligent printing machine people | |
CN207457830U (en) | A kind of regulator control system for carrying automated guided vehicle | |
CN107632284A (en) | A Mobile type indoor intelligent positioning system and method based on WIFI and RFID technique | |
TWI627839B (en) | User equipment, remote control system and method based on LoRa and RFID | |
Hudecek et al. | A system for precise positioning of vehicles aiming at increased inductive charging efficiency | |
CN109109719A (en) | A kind of unmanned electric appliance general merchandise clothes shoes and hats fortune of wisdom formula sells vehicle and business model | |
Liu et al. | Design of AGV Positioning Navigation Control System Based on Vision and RFID | |
CN210804113U (en) | Intelligent AGV terminal based on RFID |
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 |
Application publication date: 20170922 |
|
RJ01 | Rejection of invention patent application after publication |