CN110154787A - A kind of Twin Rudders wheel automatic guided vehicle and its control method - Google Patents

A kind of Twin Rudders wheel automatic guided vehicle and its control method Download PDF

Info

Publication number
CN110154787A
CN110154787A CN201910567020.XA CN201910567020A CN110154787A CN 110154787 A CN110154787 A CN 110154787A CN 201910567020 A CN201910567020 A CN 201910567020A CN 110154787 A CN110154787 A CN 110154787A
Authority
CN
China
Prior art keywords
steering wheel
travel speed
automatic guided
guided vehicle
wheel
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
Application number
CN201910567020.XA
Other languages
Chinese (zh)
Other versions
CN110154787B (en
Inventor
李蜜
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Jiangsu Yikong Intelligent Equipment Co ltd
Original Assignee
Zhejiang Billion Control Automation Equipment Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Zhejiang Billion Control Automation Equipment Co Ltd filed Critical Zhejiang Billion Control Automation Equipment Co Ltd
Priority to CN201910567020.XA priority Critical patent/CN110154787B/en
Publication of CN110154787A publication Critical patent/CN110154787A/en
Application granted granted Critical
Publication of CN110154787B publication Critical patent/CN110154787B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60LPROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L15/00Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles
    • B60L15/20Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles for control of the vehicle or its driving motor to achieve a desired performance, e.g. speed, torque, programmed variation of speed
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60LPROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L2240/00Control parameters of input or output; Target parameters
    • B60L2240/10Vehicle control parameters
    • B60L2240/12Speed
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60LPROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L2240/00Control parameters of input or output; Target parameters
    • B60L2240/10Vehicle control parameters
    • B60L2240/24Steering angle
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60LPROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L2240/00Control parameters of input or output; Target parameters
    • B60L2240/40Drive Train control parameters
    • B60L2240/42Drive Train control parameters related to electric machines
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00Road transport of goods or passengers
    • Y02T10/60Other road transportation technologies with climate change mitigation effect
    • Y02T10/72Electric energy management in electromobility

Landscapes

  • Engineering & Computer Science (AREA)
  • Power Engineering (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

A kind of Twin Rudders wheel automatic guided vehicle and its control method, this method comprises: obtaining the travel speed V and Path error of automatic guided vehicle;The travel speed V of steering wheel before being calculated according to the travel speed V and Path error of automatic guided vehicle1, steering angle θ1With the travel speed V of rear steering wheel2, steering angle θ2;According to the travel speed V of preceding steering wheel1, steering angle θ1With the travel speed V of rear steering wheel2With steering angle θ2Control automatic guided vehicle movement.By automatic guided vehicle travel speed using the two steering wheel lines of centres as X-axis, the vertical direction of the two steering wheel lines of centres be Y-axis coordinate system under decomposed, the travel speed and steering angle of two steering wheels are calculated in a coordinate system, it need to only know automatic guided vehicle travel speed V and Path error, without paying close attention to the radius of turn in automatic guided vehicle driving process, control is simple, and convenient for operation, accuracy is good.

Description

A kind of Twin Rudders wheel automatic guided vehicle and its control method
Technical field
The present invention relates to automatic guided vehicle control technology fields, and in particular to a kind of Twin Rudders wheel automatic guided vehicle and its control Method.
Background technique
Automatic guided vehicle (Automated Guided Vehicles, abbreviation AGV), automatic navigation vehicle, laser navigation vehicle. Its distinguishing feature be it is unmanned, on automatic guided vehicle be equipped with automatic guiding system, very important person can be not required to safeguards system Cargo or material can be transported to purpose from starting point automatically along scheduled route automatic running in the case where work pilotage Ground.
Currently, automatic guided vehicle has several classical field formalisms, single steering wheels such as spider gear, single steering wheel, Twin Rudders wheel, four steering wheels general Load-carrying hereinafter, single steering wheel and spider gear can only move ahead and turn round, cannot be translated in 1.5T.It is unable to satisfy demand, there have been double Steering wheel.But Twin Rudders wheel control algolithm used at present, needs to know the radius of turn of automatic guided vehicle, and existing control algolithm In, radius of turn has obtained following two mode: first is that by giving angular velocity, to calculate radius of turn, but this Mode will have a direct impact on the motion profile of car.Another kind is given trace route, and radius can be by several on full curve A point calculates, but in this manner, since trolley is dynamic operation, the motion profile of vehicle and given track For route there are deviation, the movement of vehicle in Dynamic Regulating Process, can't be overlapped with track based on the response to deviation, Influence accuracy.
In conclusion there are difficult points for the calculating of the radius R in path, and can not because current control algorithm model is complicated Find out the relationship between R and actual motion deviation, very big computational burden is caused to control system, personnel are also not easy to use It grasps, causes practice inefficiency.
Summary of the invention
To solve the above problems, this application provides a kind of Twin Rudders wheel automatic guided vehicle and its control method, the controlling party Method operation is simple, operation efficiency is high, accuracy is good, it is only necessary to know that the current location deviation of trolley and small vehicle speed can be controlled System.
In view of the above-mentioned problems, according in a first aspect, being wrapped this application provides a kind of Twin Rudders wheel automatic guided vehicle control method Include following steps:
Obtain the travel speed V and Path error of automatic guided vehicle;
The travel speed V of steering wheel before being calculated according to the travel speed V and Path error of automatic guided vehicle1, steering angle θ1 With the travel speed V of rear steering wheel2, steering angle θ2
According to the travel speed V of preceding steering wheel1, steering angle θ1With the travel speed V of rear steering wheel2With steering angle θ2Control Automatic guided vehicle movement.
In some embodiments, the travel speed of steering wheel before being calculated according to the travel speed V and Path error of automatic guided vehicle V1, steering angle θ1With the travel speed V of rear steering wheel2, steering angle θ2The step of include:
Establish coordinate system: the direction of forward and backward steering wheel line is X-direction, and the direction perpendicular to forward and backward steering wheel line is the side Y To establishing coordinate system;
It decomposes: automatic guided vehicle travel speed V is decomposed into V with Y-direction in X directionxAnd Vy, by the traveling speed of preceding steering wheel Spend V1V is decomposed into Y-direction in X direction1xAnd V1y, by the travel speed V of rear steering wheel2V is decomposed into Y-direction in X direction2xWith V2y
It calculates: according to Vx、Vy、V1x、V1y、V2xAnd V2yThe travel speed V of steering wheel before calculating1, steering angle θ1With rear rudder The travel speed V of wheel2, steering angle θ2
In some embodiments, the calculating step includes:
According to rigid principle, V is obtained1xAnd V2x
Based on automatic guided vehicle differential deviating correcting principle, V is obtained according to Path error1yAnd V2y
By V1xAnd V1yIt is synthesized, the travel speed V of steering wheel before calculating1, by V2xAnd V2yIt is synthesized, steering wheel after calculating Travel speed V2
According to V1x、V1y、V2xAnd V2yThe steering angle θ of steering wheel before calculating1With the steering angle θ of rear steering wheel2
In some embodiments, according to V1x、V1y、V2xAnd V2yThe steering angle θ of steering wheel before calculating1With the steering of rear steering wheel Angle, θ2The step of include:
According to V1xAnd V1yCalculate angle A of the line of centres of forward and backward steering wheel relative to preceding steering wheel central axes1, according to V2x And V2yCalculate angle A of the line of centres of forward and backward steering wheel relative to rear steering wheel central axes2
According to A, A1And A2The steering angle θ of steering wheel before calculating1, the steering angle θ of rear steering wheel2
Wherein, A indicates angle of the line of centres of forward and backward steering wheel relative to automatic guided vehicle central axes.
According to second aspect, this application provides a kind of Twin Rudders wheel automatic guided vehicles, comprising: bottom plate, sensor, front rudder Wheel, rear steering wheel and controller;
Be provided with battery, steering wheel mounting plate, universal wheel and card reader on the bottom plate, the battery be used for Twin Rudders wheel without The power supply of people's carrier;The steering wheel mounting plate is provided on the steering wheel mounting plate for installing the preceding steering wheel and rear steering wheel Spring shaft, the spring shaft are used for damping;The card reader is for reading site location information;
The sensor is electrically connected with the controller, and Xiang Suoshu controller is fed back apart from detection data;
The preceding steering wheel, rear steering wheel are electrically connected with the controller, the controller drive preceding steering wheel, the movement of rear steering wheel with So that the Twin Rudders wheel automatic guided vehicle movement.
In some embodiments, the controller is used for travel speed V and Path error according to preset automatic guided vehicle The travel speed V of steering wheel before calculating1, steering angle θ1With the travel speed V of rear steering wheel2, steering angle θ2, further according to front rudder The travel speed V of wheel1, steering angle θ1With the travel speed V of rear steering wheel2With steering angle θ2Front/rear steering wheel is driven to move, control Automatic guided vehicle movement processed.
Battery mounting bracket and card reader rack, the battery installation are additionally provided in some embodiments, the bottom plate Bracket is for placing the battery, and the card reader rack is for placing the card reader.
The damping mounting plate for installing spring shaft is provided in some embodiments, the steering wheel mounting plate.
According to the third aspect, this application provides a kind of Twin Rudders wheel automatic guided vehicles, comprising:
Memory, for storing program;
Processor, for the program by executing the memory storage to realize method as described in relation to the first aspect.
According to fourth aspect, present invention also provides a kind of computer readable storage medium, including program, described program energy It is enough executed by processor to realize method as described in relation to the first aspect.
AGV is advanced due to Twin Rudders wheel automatic guided vehicle provided by the present application and its control method according to above-described embodiment Speed using the two steering wheel lines of centres as X-axis, the vertical direction of the two steering wheel lines of centres be Y-axis coordinate system under decomposed, The travel speed and steering angle for calculating two steering wheels in a coordinate system, without paying close attention to the rotation in automatic guided vehicle driving process Radius, control is simple, and accuracy is good.
Detailed description of the invention
Fig. 1 is the flow chart of the Twin Rudders wheel AGV control method of the application;
Fig. 2 is the Twin Rudders wheel AGV resolution of velocity schematic diagram of the application;
Fig. 3 is the structural schematic diagram of the Twin Rudders wheel AGV of the application;
Fig. 4 is the bottom view of the Twin Rudders wheel AGV of the application.
Specific embodiment
Below by specific embodiment combination attached drawing, invention is further described in detail.Wherein different embodiments Middle similar component uses associated similar element numbers.In the following embodiments, many datail descriptions be in order to The application is better understood.However, those skilled in the art can recognize without lifting an eyebrow, part of feature It is dispensed, or can be substituted by other elements, material, method in varied situations.In some cases, this Shen Please it is relevant it is some operation there is no in the description show or describe, this is the core in order to avoid the application by mistake More descriptions are flooded, and to those skilled in the art, these relevant operations, which are described in detail, not to be necessary, they Relevant operation can be completely understood according to the general technology knowledge of description and this field in specification.
It is formed respectively in addition, feature described in this description, operation or feature can combine in any suitable way Kind embodiment.Meanwhile each step in method description or movement can also can be aobvious and easy according to those skilled in the art institute The mode carry out sequence exchange or adjustment seen.Therefore, the various sequences in the description and the appended drawings are intended merely to clearly describe a certain A embodiment is not meant to be necessary sequence, and wherein some sequentially must comply with unless otherwise indicated.
As shown in Figs. 1-2, this application provides a kind of Twin Rudders wheel automatic guided vehicle control methods, comprising the following steps:
S1: the travel speed V of AGV is obtained;
S2: the travel speed V of steering wheel before being calculated according to the travel speed V and Path error of AGV1, steering angle θ1With it is rear The travel speed V of steering wheel2, steering angle θ2
S3: according to the travel speed V of preceding steering wheel1, steering angle θ1With the travel speed V of rear steering wheel2With steering angle θ2Control AGV movement processed.
In some embodiments, the travel speed V of steering wheel before being calculated according to the travel speed V and Path error of AGV1, turn to Angle, θ1With the travel speed V of rear steering wheel2, steering angle θ2The step of include:
Establish coordinate system: the direction of forward and backward steering wheel line is X-direction, and the direction perpendicular to forward and backward steering wheel line is the side Y To establishing coordinate system;
It decomposes: AGV travel speed V is decomposed into V with Y-direction in X directionxAnd Vy, by the travel speed V of preceding steering wheel1Along X Direction and Y-direction are decomposed into V1xAnd V1y, by the travel speed V of rear steering wheel2V is decomposed into Y-direction in X direction2xAnd V2y
It calculates: according to Vx、Vy、V1x、V1y、V2xAnd V2yThe travel speed V of steering wheel before calculating1, steering angle θ1With rear rudder The travel speed V of wheel2, steering angle θ2
Specifically, calculating step includes:
According to rigid principle, for the rigid body of two o'clock connecting shaft, speed is consistent in X-direction, obtains V1x=V2x=Vx
For in Y-direction, since automatic guided vehicle central point is at the midpoint of the forward and backward steering wheel line of centres, according to differential mould Type is it can be concluded that (V1y+V2y)/2=Vy
With reference to " Chinese journal of scientific instrument " the 4th phase of volume 38 in April, 2017 publish paper " based on optimal offset path from Dynamic guiding vehicle method for correcting error ", it is based on existing AGV differential deviating correcting principle, according to Path error, show that Δ V, Δ V indicate front rudder Wheel and the speed difference of rear steering wheel in the Y direction, calculate: V further according to Δ V1y=Vy+ Δ V, V2y=Vy-ΔV。
By V1xAnd V1yIt is synthesized, the travel speed of steering wheel before calculatingBy V2xWith V2yIt is synthesized, the travel speed of steering wheel after calculating
According to V1x、V1y、V2xAnd V2yThe steering angle θ of steering wheel before calculating1With the steering angle θ of rear steering wheel2.Specifically, According to preceding steering wheel or rear steering wheel to the horizontal distance W of automatic guided vehicle central point, preceding steering wheel or rear steering wheel into automatic guided vehicle The line of centres that the vertical range L of heart point calculates forward and backward steering wheel is relative to the angle of automatic guided vehicle central axesAccording to V1xAnd V1yCalculate angle of the line of centres of forward and backward steering wheel relative to preceding steering wheel central axesAccording to V2xAnd V2yCalculate angle of the line of centres of forward and backward steering wheel relative to rear steering wheel central axes Degree
According to A, A1And A2The steering angle of steering wheel before calculatingThe steering of steering wheel afterwards Angle
The Twin Rudders wheel automatic guided vehicle control method of the application, it is only necessary to know that AGV travel speed V and Path error can be counted The speed of travel V of steering wheel before calculating1With steering angle θ1, the travel speed V of rear steering wheel2With steering angle θ2, without paying close attention to AGV Radius of turn in driving process, simplifies control mode, links up AGV Path error and speed, angle well, Convenient for operation, accuracy is good.
As shown in Figure 3-4, present invention also provides a kind of Twin Rudders wheel automatic guided vehicle, the Twin Rudders wheel automatic guided vehicle packets Include: bottom plate 1, sensor 2, preceding steering wheel 4, rear steering wheel 5 and controller 3, preceding steering wheel 4 are moved with rear steering wheel 5 so that the Twin Rudders Take turns AGV movement.
Battery mounting bracket 11, steering wheel mounting plate 12, universal wheel 13 and card reader rack 14, battery are provided on bottom plate 1 Mounting bracket 11 is used for placing battery 111, and battery 111 is used to power to Twin Rudders wheel AGV.Steering wheel mounting plate 12 is for installing front rudder 4 and rear steering wheel 5 are taken turns, the damping mounting plate 121 for installing spring shaft 122 is provided on steering wheel mounting plate 12, spring shaft 122 is used Vibration in reduction AGV traveling process.Card reader rack 14 is for placing card reader 141, and card reader 141 is for reading RFID Card, to read site location information.
Sensor 2 includes one of ultrasonic sensor, visual sensor, infrared sensor and laser sensor, is played It navigates, the effect of positioning and avoidance.
The row of steering wheel before controller 3 is used to be calculated according to the travel speed V and Path error of preset automatic guided vehicle Into speed V1, steering angle θ1With the travel speed V of rear steering wheel2, steering angle θ2
Controller 3 is also used to the travel speed V according to preceding steering wheel1, steering angle θ1With the travel speed V of rear steering wheel2With turn To angle, θ2Control AGV movement.
With reference to Fig. 1, specifically, in some embodiments, controller 3 is also used to:
Establish coordinate system: the direction of forward and backward steering wheel line is X-direction, and the direction perpendicular to forward and backward steering wheel line is the side Y To establishing coordinate system;
It decomposes: automatic guided vehicle travel speed V is decomposed into V with Y-direction in X directionxAnd Vy, by the traveling speed of preceding steering wheel Spend V1V is decomposed into Y-direction in X direction1xAnd V1y, by the travel speed V of rear steering wheel2V is decomposed into Y-direction in X direction2xWith V2y
It calculates: according to Vx、Vy、V1x、V1y、V2xAnd V2yThe travel speed V of steering wheel before calculating1, steering angle θ1With rear rudder The travel speed V of wheel2, steering angle θ2
This application provides a kind of Twin Rudders wheel automatic guided vehicle, which includes:
Memory, for storing program;
Processor, for the program by executing the memory storage to realize method as described above.
Present invention also provides a kind of computer readable storage medium, including program, described program can be held by processor Row is to realize method as described above.
It will be understood by those skilled in the art that all or part of function of various methods can pass through in above embodiment The mode of hardware is realized, can also be realized by way of computer program.When function all or part of in above embodiment When being realized by way of computer program, which be can be stored in a computer readable storage medium, and storage medium can To include: read-only memory, random access memory, disk, CD, hard disk etc., it is above-mentioned to realize which is executed by computer Function.For example, program is stored in the memory of equipment, when executing program in memory by processor, can be realized State all or part of function.In addition, when function all or part of in above embodiment is realized by way of computer program When, which also can store in storage mediums such as server, another computer, disk, CD, flash disk or mobile hard disks In, through downloading or copying and saving into the memory of local device, or version updating is carried out to the system of local device, when logical When crossing the program in processor execution memory, all or part of function in above embodiment can be realized.
Use above specific case is illustrated the present invention, is merely used to help understand the present invention, not to limit The system present invention.For those skilled in the art, according to the thought of the present invention, can also make several simple It deduces, deform or replaces.

Claims (10)

1. a kind of Twin Rudders wheel automatic guided vehicle control method, which comprises the following steps:
Obtain the travel speed V and Path error of automatic guided vehicle;
The travel speed V of steering wheel before being calculated according to the travel speed V and Path error of automatic guided vehicle1, steering angle θ1With it is rear The travel speed V of steering wheel2, steering angle θ2
According to the travel speed V of preceding steering wheel1, steering angle θ1With the travel speed V of rear steering wheel2With steering angle θ2Nobody is controlled to remove Transport Che Yundong.
2. control method as described in claim 1, which is characterized in that inclined according to the travel speed V of automatic guided vehicle and path The travel speed V of steering wheel before difference calculates1, steering angle θ1With the travel speed V of rear steering wheel2, steering angle θ2The step of include:
Establish coordinate system: the direction of forward and backward steering wheel line is X-direction, is built perpendicular to the direction of forward and backward steering wheel line for Y-direction Vertical coordinate system;
It decomposes: automatic guided vehicle travel speed V is decomposed into V with Y-direction in X directionxAnd Vy, by the travel speed V of preceding steering wheel1 V is decomposed into Y-direction in X direction1xAnd V1y, by the travel speed V of rear steering wheel2V is decomposed into Y-direction in X direction2xAnd V2y
It calculates: according to Vx、Vy、V1x、V1y、V2xAnd V2yThe travel speed V of steering wheel before calculating1, steering angle θ1With rear steering wheel Travel speed V2, steering angle θ2
3. control method as claimed in claim 2, which is characterized in that the calculating step includes:
According to rigid principle, V is obtained1xAnd V2x
Based on automatic guided vehicle differential deviating correcting principle, V is obtained according to Path error1yAnd V2y
By V1xAnd V1yIt is synthesized, the travel speed V of steering wheel before calculating1, by V2xAnd V2yIt is synthesized, the row of steering wheel after calculating Into speed V2
According to V1x、V1y、V2xAnd V2yThe steering angle θ of steering wheel before calculating1With the steering angle θ of rear steering wheel2
4. control method as claimed in claim 3, which is characterized in that according to V1x、V1y、V2xAnd V2ySteering wheel turns before calculating To angle, θ1With the steering angle θ of rear steering wheel2The step of include:
According to V1xAnd V1yCalculate angle A of the line of centres of forward and backward steering wheel relative to preceding steering wheel central axes1, according to V2xAnd V2y Calculate angle A of the line of centres of forward and backward steering wheel relative to rear steering wheel central axes2
According to A, A1And A2The steering angle θ of steering wheel before calculating1, the steering angle θ of rear steering wheel2
Wherein, A indicates angle of the line of centres of forward and backward steering wheel relative to automatic guided vehicle central axes.
5. a kind of Twin Rudders wheel automatic guided vehicle characterized by comprising bottom plate, sensor, preceding steering wheel, rear steering wheel and controller;
Battery, steering wheel mounting plate, universal wheel and card reader are provided on the bottom plate, the battery is for nobody to remove to Twin Rudders wheel Transport vehicle power supply;The steering wheel mounting plate is provided with spring on the steering wheel mounting plate for installing the preceding steering wheel and rear steering wheel Axis, the spring shaft are used for damping;The card reader is for reading site location information;
The sensor is electrically connected with the controller, and Xiang Suoshu controller is fed back apart from detection data;
The preceding steering wheel, rear steering wheel are electrically connected with the controller, the controller drive preceding steering wheel, the movement of rear steering wheel so that The Twin Rudders wheel automatic guided vehicle movement.
6. Twin Rudders wheel automatic guided vehicle as described in claim 1, which is characterized in that the controller is used for according to preset nothing The travel speed V of steering wheel before the travel speed V and Path error of people's carrier are calculated1, steering angle θ1With the traveling of rear steering wheel Speed V2, steering angle θ2, further according to the travel speed V of preceding steering wheel1, steering angle θ1With the travel speed V of rear steering wheel2And steering Angle, θ2Front/rear steering wheel is driven to move, control automatic guided vehicle movement.
7. Twin Rudders wheel automatic guided vehicle as claimed in claim 5, which is characterized in that be additionally provided with battery installation on the bottom plate Bracket and card reader rack, for the battery mounting bracket for placing the battery, the card reader rack is described for placing Card reader.
8. Twin Rudders wheel automatic guided vehicle as claimed in claim 5, which is characterized in that be provided with and be used on the steering wheel mounting plate The damping mounting plate of spring shaft is installed.
9. a kind of Twin Rudders wheel automatic guided vehicle characterized by comprising
Memory, for storing program;
Processor, for the program by executing the memory storage to realize as of any of claims 1-4 Method.
10. a kind of computer readable storage medium, which is characterized in that including program, described program can be executed by processor with Realize such as method of any of claims 1-4.
CN201910567020.XA 2019-06-27 2019-06-27 Double-rudder-wheel unmanned carrier and control method thereof Active CN110154787B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910567020.XA CN110154787B (en) 2019-06-27 2019-06-27 Double-rudder-wheel unmanned carrier and control method thereof

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910567020.XA CN110154787B (en) 2019-06-27 2019-06-27 Double-rudder-wheel unmanned carrier and control method thereof

Publications (2)

Publication Number Publication Date
CN110154787A true CN110154787A (en) 2019-08-23
CN110154787B CN110154787B (en) 2023-08-15

Family

ID=67637085

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910567020.XA Active CN110154787B (en) 2019-06-27 2019-06-27 Double-rudder-wheel unmanned carrier and control method thereof

Country Status (1)

Country Link
CN (1) CN110154787B (en)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111323019A (en) * 2020-03-25 2020-06-23 浙江亿控自动化设备有限公司 Path planning method for magnetic navigation AGV
CN111497637A (en) * 2020-05-29 2020-08-07 浙江同筑科技有限公司 Motion control method for AGV with four steering wheels
CN111679676A (en) * 2020-06-19 2020-09-18 重庆大学 AGV movement track control method
CN111830980A (en) * 2020-07-14 2020-10-27 深圳市高步达智能科技有限公司 Laser navigation path following method

Citations (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH1011139A (en) * 1996-06-27 1998-01-16 Nissan Motor Co Ltd Method and device for controlling steering of unmanned carrier
JPH1097321A (en) * 1996-09-24 1998-04-14 Mitsubishi Heavy Ind Ltd Travel controller for automated guided vehicle
JPH11231939A (en) * 1998-02-16 1999-08-27 Shinko Electric Co Ltd Method and device for controlling steering of unmanned vehicle
JP2002041147A (en) * 2000-07-24 2002-02-08 Sumitomo Heavy Ind Ltd Method for controlling carrier and device for the time
JP2010256941A (en) * 2009-04-21 2010-11-11 Meidensha Corp Steering drive method and device for automated guided vehicle
CN103488174A (en) * 2013-09-16 2014-01-01 北京邮电大学 Automatic guiding control method, device and system
CN104111657A (en) * 2014-08-13 2014-10-22 成都四威高科技产业园有限公司 Automatic guided vehicle capable of driving in all directions
CN104407615A (en) * 2014-11-03 2015-03-11 上海电器科学研究所(集团)有限公司 AGV robot guide deviation correction method
CN106585764A (en) * 2017-02-07 2017-04-26 河南森源电气股份有限公司 AGV (Automated Guided Vehicle)
CN106886222A (en) * 2017-03-29 2017-06-23 北京京东尚科信息技术有限公司 The control method and device of automatic guided vehicle
CN107539163A (en) * 2016-06-23 2018-01-05 沈阳新松机器人自动化股份有限公司 A kind of drive device, diagonal wheel apparatus and its motion control method
CN108052107A (en) * 2018-01-19 2018-05-18 浙江科钛机器人股份有限公司 A kind of AGV indoor and outdoor complex navigation system and methods for merging magnetic stripe, magnetic nail and inertial navigation
CN108388241A (en) * 2018-01-05 2018-08-10 广州科语机器人有限公司 The path following method of mobile robot
CN109144078A (en) * 2018-11-13 2019-01-04 楚天智能机器人(长沙)有限公司 One kind being based on the conllinear Twin Rudders wheel AGV route method for correcting error of two-dimension code navigation and system
CN109407666A (en) * 2018-10-11 2019-03-01 智久(厦门)机器人科技有限公司上海分公司 A kind of control method of vehicle, device, equipment and storage medium
CN210309945U (en) * 2019-06-27 2020-04-14 浙江亿控自动化设备有限公司 Double-rudder-wheel unmanned carrying vehicle

Patent Citations (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH1011139A (en) * 1996-06-27 1998-01-16 Nissan Motor Co Ltd Method and device for controlling steering of unmanned carrier
JPH1097321A (en) * 1996-09-24 1998-04-14 Mitsubishi Heavy Ind Ltd Travel controller for automated guided vehicle
JPH11231939A (en) * 1998-02-16 1999-08-27 Shinko Electric Co Ltd Method and device for controlling steering of unmanned vehicle
JP2002041147A (en) * 2000-07-24 2002-02-08 Sumitomo Heavy Ind Ltd Method for controlling carrier and device for the time
JP2010256941A (en) * 2009-04-21 2010-11-11 Meidensha Corp Steering drive method and device for automated guided vehicle
CN103488174A (en) * 2013-09-16 2014-01-01 北京邮电大学 Automatic guiding control method, device and system
CN104111657A (en) * 2014-08-13 2014-10-22 成都四威高科技产业园有限公司 Automatic guided vehicle capable of driving in all directions
CN104407615A (en) * 2014-11-03 2015-03-11 上海电器科学研究所(集团)有限公司 AGV robot guide deviation correction method
CN107539163A (en) * 2016-06-23 2018-01-05 沈阳新松机器人自动化股份有限公司 A kind of drive device, diagonal wheel apparatus and its motion control method
CN106585764A (en) * 2017-02-07 2017-04-26 河南森源电气股份有限公司 AGV (Automated Guided Vehicle)
CN106886222A (en) * 2017-03-29 2017-06-23 北京京东尚科信息技术有限公司 The control method and device of automatic guided vehicle
CN108388241A (en) * 2018-01-05 2018-08-10 广州科语机器人有限公司 The path following method of mobile robot
CN108052107A (en) * 2018-01-19 2018-05-18 浙江科钛机器人股份有限公司 A kind of AGV indoor and outdoor complex navigation system and methods for merging magnetic stripe, magnetic nail and inertial navigation
CN109407666A (en) * 2018-10-11 2019-03-01 智久(厦门)机器人科技有限公司上海分公司 A kind of control method of vehicle, device, equipment and storage medium
CN109144078A (en) * 2018-11-13 2019-01-04 楚天智能机器人(长沙)有限公司 One kind being based on the conllinear Twin Rudders wheel AGV route method for correcting error of two-dimension code navigation and system
CN210309945U (en) * 2019-06-27 2020-04-14 浙江亿控自动化设备有限公司 Double-rudder-wheel unmanned carrying vehicle

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111323019A (en) * 2020-03-25 2020-06-23 浙江亿控自动化设备有限公司 Path planning method for magnetic navigation AGV
CN111497637A (en) * 2020-05-29 2020-08-07 浙江同筑科技有限公司 Motion control method for AGV with four steering wheels
CN111497637B (en) * 2020-05-29 2023-03-10 浙江同筑科技有限公司 Motion control method for AGV (automatic guided vehicle) with four steering wheels
CN111679676A (en) * 2020-06-19 2020-09-18 重庆大学 AGV movement track control method
CN111830980A (en) * 2020-07-14 2020-10-27 深圳市高步达智能科技有限公司 Laser navigation path following method
CN111830980B (en) * 2020-07-14 2023-11-03 上海同普电力技术有限公司 Laser navigation path following method

Also Published As

Publication number Publication date
CN110154787B (en) 2023-08-15

Similar Documents

Publication Publication Date Title
CN110154787A (en) A kind of Twin Rudders wheel automatic guided vehicle and its control method
CN106970629B (en) Control method and device for automated guided vehicle
Zhao et al. Design of a control system for an autonomous vehicle based on adaptive-pid
CN104512462B (en) Track maintains control device and method
US20170060133A1 (en) Apparatus and method for controlling autonomous navigation
CN109080631A (en) The system and method for low speed crosswise joint for vehicle
CN106950972A (en) A kind of automatic guided vehicle AGV and its route method for correcting error
CN111121777A (en) Unmanned equipment trajectory planning method and device, electronic equipment and storage medium
CN110341688B (en) Front wheel steering angle compensation method and device, vehicle-mounted equipment and storage medium
CN103383570A (en) Automatic guided vehicle capable of moving in all directions
CN109415056B (en) Travel track generation device, travel track generation method, travel track generation program, and driving assistance device and driving assistance system
CN102039894A (en) Autonomous parking strategy of the vehicle with rear steer
CN109850012A (en) A kind of unmanned vehicle crosswise joint method, apparatus, system and storage medium
CN110487285B (en) Path planning control method and electronic equipment for low-speed turning of vehicle
CN107132843B (en) Control method and device for automated guided vehicle
CN113696970B (en) Semi-trailer train, backing control method, device, equipment and medium
US20210261118A1 (en) Enhanced object detection and response
CN112051864A (en) Method, device, equipment and readable medium for tracking moving target track
CN114995267A (en) Method and device for adjusting pose of trailer, electronic equipment and storage medium
Yin et al. Combinatorial inertial guidance system for an automated guided vehicle
CN111679676A (en) AGV movement track control method
CN109839930B (en) Obstacle avoidance device, system and method
CN210309945U (en) Double-rudder-wheel unmanned carrying vehicle
CN106292660B (en) Balance car course corrections device and method based on odometer and gray-scale sensor
CN112947487B (en) Automatic guided vehicle and curve path tracking method and control device thereof

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
GR01 Patent grant
GR01 Patent grant
CP03 Change of name, title or address

Address after: Building 63, No. 2699 Bingang Avenue, Binjiang Street, Haimen District, Nantong City, Jiangsu Province, 226100

Patentee after: Jiangsu yikong Intelligent Equipment Co.,Ltd.

Address before: 322000 4th floor, building 6, No. 288, Yangcun Road, Houjiang street, Yiwu, Jinhua City, Zhejiang Province (Yiwu high level talent entrepreneurship Park)

Patentee before: ZHEJIANG YI KONG AUTOMATION EQUIPMENT Co.,Ltd.

CP03 Change of name, title or address