CN1864941A - Driving and reversing gear of robot moving platform - Google Patents
Driving and reversing gear of robot moving platform Download PDFInfo
- Publication number
- CN1864941A CN1864941A CN 200610027197 CN200610027197A CN1864941A CN 1864941 A CN1864941 A CN 1864941A CN 200610027197 CN200610027197 CN 200610027197 CN 200610027197 A CN200610027197 A CN 200610027197A CN 1864941 A CN1864941 A CN 1864941A
- Authority
- CN
- China
- Prior art keywords
- wheel
- driving
- control
- servomotor
- changement
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Landscapes
- Toys (AREA)
- Manipulator (AREA)
Abstract
The invention relates to a driving and steering device used in movable robot platform, belonging to the robot technique. Wherein, said device uses four-wheel coordinate structure, which comprises one main body and four wheels that combines driving and steering functions; the driving and steering functions of each wheel can be independently controlled; the driving functions is realized by the direct-current servo motor via the worm wheel reducer and chain wheel transmission; the steering function is realized by the direct-current servo motor via the reducer and high-efficiency gear transmission, to control the position accurately. Said system utilizes PID feedback control, to control the speed of servo motor accurately, to control the speed, direction and position of main body. The invention with said driving and steering device has flexible motion, high control accuracy and high maintenance ability, to realize in-site turning of whole movable platform. The invention can be used in the driving and steering platform of serve robot.
Description
Technical field
The invention belongs to the Robotics field, be specifically related to a kind of wheeled mobile robot body and drive and changement.Can be applicable to the driving and the gimbaled platform of service robots such as robot research and venue guide, the assistant of family.
Background technology
Along with the development of technology such as sensor, control and computer, intelligent robot system is the service industry outside the manufacturing field at first, has opened up the frontier of robot application.Robot has become human assistant, has improved people's quality of life.In the field of study, the robot that develops the same thinking of the similar mankind also no longer is a thing abysmal, not within the foreseeable future.
Flexibility, real-time and stability that robot moves (comprise and driving and commutation) are examination robot performance's important indicators.Locomotive function not only needs to satisfy the needs of all kinds of intelligent algorithms, and will consider the cost requirement of industrialization aspect.An idealized perfect portable service-delivery machine robot system is made up of 3 parts usually: travel mechanism, sensory perceptual system and control system.Travel mechanism is the body of robot, the space of decision robot, and it is several to mainly contain walking mechanism, wheeled mechanism, crawler type mechanism and mixed organization etc.Wheeled mechanism controls is simple, and is fast with respect to walking mechanism and crawler type mechanism less energy intensive, movement velocity, thereby uses more.Wheeled mechanism can be divided into the differential driving formula and separate two kinds of drive-types according to the mode of direction control.The differential driving formula adopt identical wheel and driver drive with controlling party to, the change of direction is to realize by the speed difference of controlling each wheel.Separating drive-type is to adopt different directions and driving governor on identical wheel respectively, and movement velocity and direction are controlled respectively.
The structure of wheeled mobile platform mainly contains three wheeled and four-wheel-type structures.Three wheeled structures are the most frequently used, and its typical structure is to utilize two high-precision driving wheels and a supporting roller structure.Two driving wheels are driven through behind the decelerator by two motors respectively, and supporting roller can place the front portion or the rear portion of body.The commutation of mobile platform is by the speed difference decision of two driving wheels, by two motors are applied the motion that different speed controlled quentity controlled variables can realize any direction.The version that a kind of single wheel drive and commutation are also arranged, promptly front-wheel be driving wheel also be Steering Wheel, it needs two independent motors to lead and drives control.Also have a kind of synchronously driven configuration mode, three wheels evenly distribute, and with gear or chain wheel are linked to each other to the motor with driving with the difference controlling party, and the drive motors wheels is advanced, the commutation of guide motor control wheel.The four-wheel structure also has the various configuration modes that are similar to tricycle structure, as compound control of driving-commutation and mode such as control respectively.But because traditional four wheel mechanism radius of gyration is bigger, it is dumb to commutate, thereby adopts the mobile robot of four-wheel structure actually rare.
In a word, present mobile robot platform structure respectively has pluses and minuses, also is difficult to take into account the simplicity of structure and the flexibility of control.In addition, develop the intelligent robot that carries out autonomous learning as the people, its mobility need satisfy the needs of growing algorithm, need full constraint and full control such as the entire mechanism free degree, can carry out pivot stud, and it is flexible to commutate etc., and traditional robot moving structure is difficult to satisfy above-mentioned requirements.
Summary of the invention
The purpose of this invention is to provide a kind of driving and changement that can be used for robot moving platform, utilize the robot body of this driving and commutating structure design can have motion flexibly, characteristics such as control accuracy is high, maintainability is strong, and function such as is turned round in the original place that can realize whole mobile platform.
The driving that can be used for robot moving platform and the changement of the present invention's design adopt four-wheel cooperative type structure, comprise that a body and four collection drive and the wheel that turns on one; The driving of each wheel and commutation are by independent servomotor control, wherein, the driving mechanism that seesaws of control wheel is by a servomotor, worm type of reduction gearing, with the coaxial sprocket wheel of worm gear, form with coaxial sprocket wheel of motion wheel and the chain that is used for transmission between two sprocket wheels; The decelerator that the changement that turns to of control wheel is made up of another servomotor, pinion and gear wheel constitutes, and gear wheel is that straight-tooth is connected with the stent strut that is used to install wheel.This servomotor rotates, and through the transmission of pinion and gear wheel, the stent strut that drives wheel rotates, and realizes the commutation of rotor.
The present invention also comprises a control system.This control system is carried out Synchronization Control to the servomotor that is used on each wheel to drive and commutate, synthetic body move forward and backward with direction such as all angles on motion.
Among the present invention, described wheel can adopt the rubber wheel, and is eccentric structure, to strengthen whole system commutation flexibility.
The present invention adopts four-wheel cooperative type structure, and the driving of each wheel and commutation by a servomotor control, therefore, have 8 servomotors respectively.Its control system adopts the FDCX08 real-time multi-task operating system, controls a servomotor by the node of CAN.Main task is exactly to accept the order of host computer, and the state of control motor, switch or inquiry motor, sampled point has characteristics such as volume is little, real-time, user interface is simple.This control system comprises a CAN interface card, is used for being connected with the communication of PC master control borad, and 8 servomotor motions of CAN bus synchronous control, 8 servomotors all adopt independently PID closed loop control.Each servo control system comprises a controller, a driver and a photoelectric encoder, photoelectric encoder converts the mechanism's geometric displacement amount on the servomotor output shaft to pulse or digital quantity by opto-electronic conversion, and the speed of motor and the information of position sent to controller in real time, control the voltage that is added on the motor together by pulsewidth modulation (PWM) and microprocessor again, relevant information is flowed to driver, finally drive servomotor speed and direction operation on request.
Above-mentioned controller carries out real-time Synchronization Control according to the four-wheel tuning algorithm to the drive unit and the reversing arrangement of each wheel, and the rapport of four wheels is relevant with the physical dimension of main body mechanism.
It is that master, Alternating Current Power Supply are the scheme of assisting that power unit of the present invention is taked lead-acid accumulator direct current supply.Under the normal condition, robot platform provides power by dc source.When DC power supply is not enough, can change Alternating Current Power Supply into, simultaneously direct-flow storage battery is charged.Drives structure and commutating structure all can adopt the DC servo motor of 24V, and the planetary reducer of built-in big retarding ratio is to improve driving torque, and the encoder of external 1000 lines is realized the feedback information between servomotor and the controller.
Whole system driving of the present invention and commutating structure are very compact, and volume is little.System platform operates steadily, and type of drive is reliable, effectively, is very suitable for the mobile platform of research field and all kinds of service field robot.
Description of drawings
Fig. 1 four-wheel coordinated movement of various economic factors of the present invention schematic diagram.
Fig. 2 driving mechanism of the present invention and changement transmission principle figure.
Fig. 3 control principle figure of the present invention.
Number in the figure: 1 is the chassis, and 2 is the 1st wheel, and 3 is the 2nd wheel, and 4 is the 3rd wheel, 5 is the 4th wheel, and 6 is the driving mechanism motor, and 7 is worm screw, and 8 is worm gear, 9 is the changement motor, and 10 is sprocket wheel, and 11 is chain, and 12 is gear, 13 is rubber wheel, and 14 is sprocket wheel, and 15 is bracing frame, and 16 is bearing, 17 is gear, and 18 is the CAN interface card, and 19 is master control borad, and 20 is the motor closed-loop control, 21 is DC servo motor, and 22 is encoder, and 23 is driver, and 24 is controller.
The specific embodiment
Further describe the present invention below in conjunction with drawings and Examples.
Structure of the present invention is driving and the commutating structure that a kind of four-wheel is coordinated, and sees Fig. 1, and 1 four jiaos are uniform-distribution with wheel 2,3,4 and 5 on the chassis.The eccentric distance of each wheel is b, has two freedoms of motion independently mutually, promptly drives free degree θ and commutation free degree ω.
Driving is realized through worm type of reduction gearing and chain gear transmission mode by DC servo motor, and finishes the Position Control of degree of precision.
Commutation is realized through deceleration device and high efficiency gear transmission mode by DC servo motor, and finishes the Position Control of degree of precision.
Each rubber wheel all possesses functions such as driving and commutation, all adopts eccentric structure.
Control system requires to be decomposed into control command to 8 servomotors to the motion of mobile platform according to the four-wheel tuning algorithm, controls moving or rotating to finish the motion of body of each wheel.Wherein, Synchronization Control is carried out in four drivings and four commutation dress back ofs the body, the rapport of four wheels is relevant with the incorporating parametric of body.
Fig. 2 is each wheel driving mechanism and changement principle schematic.
Driving mechanism is driven by DC servo motor 6.Because traditional Bevel Gear Transmission mode is higher to matching requirements, the present invention adopts worm screw 7, worm gear 8 reducing gears as first order transmission.Realize second level transmission through sprocket wheel 10, chain 11 and sprocket wheel 14 again, finally drive the rolling that rubber wheel 13 is realized fore-and-aft direction.
Changement is driven by DC servo motor 9, and through the transmission of pinion 12 and gear wheel 17, the bracing frame 15 that drives the rubber wheel is realized the commutation motion.Whole changement is supported on the chassis 1 by bearing 16, and motor 6 and 9 also all is fixed together with chassis 16.
Fig. 3 is the control principle figure of servomotor.Control system realizes being connected with the communication of PC master control borad 19 by CAN interface card 18, and the motion of 8 servomotors of Synchronization Control.Independently PID closed loop control 20 is all adopted in 8 servomotor controls, at the front end of servomotor 21, photoelectric encoder 22 is housed, and it is a kind of sensor that the geometry of machinery displacement on the motor output shaft is converted to pulse or digital quantity by opto-electronic conversion.Just can reflect current rotating speed of motor by the number of calculating per second photoelectric encoder output pulse.Encoder 22 sends to controller 24 in real time with the speed or the positional information of motor; control the voltage that is added on the motor together by pulsewidth modulation (PWM) technology and microprocessor; relevant information is flowed to driver 23 with overcurrent protection function; the final speed and convenient together operation of servomotor 21 to require that drives is to reach desirable position.
Claims (4)
1, a kind of driving of robot moving platform and changement, the structure of employing four-wheel cooperative type is characterized in that this mechanism comprises a body and four wheels that integrate driving and commutate, the driving of each wheel and commutation all can be controlled separately; Wherein, the driving mechanism that seesaws of control wheel is by the coaxial sprocket wheel of a servomotor, worm type of reduction gearing and worm gear, form with coaxial sprocket wheel of motion wheel and the chain that is used for transmission between two sprocket wheels; The decelerator that the changement that turns to of control wheel is made up of another servomotor, pinion and gear wheel constitutes, gear wheel is that straight-tooth is connected with the stent strut that is used to install wheel, this servomotor rotates, transmission through pinion and gear wheel, the stent strut that drives wheel rotates, and realizes the commutation of rotor.
2, the driving of robot moving platform according to claim 1 and changement, it is characterized in that also comprising a control system, this control system is carried out Synchronization Control to the servomotor that is used on each wheel to drive and commutate, synthetic body move forward and backward with all angles direction on motion.
3, the driving and the changement of mechanism according to claim 2 device mobile platform, it is characterized in that described control system comprises a controller, a driver and a photoelectric encoder, photoelectric encoder converts the mechanism's geometric displacement amount on the servomotor output shaft to pulse or digital quantity by opto-electronic conversion, and the speed of motor and the information of position sent to controller in real time, control the voltage that is added on the motor together by pulse modulation technology and microprocessor again, relevant information is flowed to driver, finally drive servomotor speed and direction operation on request.
4, the driving and the changement of mechanism according to claim 2 device mobile platform is characterized in that each wheel adopts rubber wheel, and are eccentric structure.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CNB2006100271973A CN100382935C (en) | 2006-06-01 | 2006-06-01 | Driving and reversing gear of robot moving platform |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CNB2006100271973A CN100382935C (en) | 2006-06-01 | 2006-06-01 | Driving and reversing gear of robot moving platform |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN1864941A true CN1864941A (en) | 2006-11-22 |
| CN100382935C CN100382935C (en) | 2008-04-23 |
Family
ID=37424160
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CNB2006100271973A Expired - Fee Related CN100382935C (en) | 2006-06-01 | 2006-06-01 | Driving and reversing gear of robot moving platform |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN100382935C (en) |
Cited By (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101850727A (en) * | 2010-02-26 | 2010-10-06 | 湖南山河智能机械股份有限公司 | Remote control wheel type mobile robot platform |
| CN103273476A (en) * | 2013-04-27 | 2013-09-04 | 国家电网公司 | Relay protection room inspection tour robot |
| CN108227530A (en) * | 2018-01-08 | 2018-06-29 | 浙江立石机器人技术有限公司 | A kind of kinetic control system and control method |
| CN108372502A (en) * | 2018-01-08 | 2018-08-07 | 浙江立石机器人技术有限公司 | A kind of robot movement-control system and control method |
| CN108972588A (en) * | 2018-08-29 | 2018-12-11 | 上海常仁信息科技有限公司 | Intelligence backtracks the robot of charging |
| CN109440699A (en) * | 2018-12-07 | 2019-03-08 | 长沙中联重科环境产业有限公司 | Environmental sanitation is intelligently clean to sweep Work robot control system and cleaning machine |
| CN109521776A (en) * | 2018-12-31 | 2019-03-26 | 天合光能股份有限公司 | Chassis control system of intelligent robot |
Families Citing this family (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CZ305593B6 (en) * | 2013-09-25 | 2015-12-30 | Vysoké Učení Technické V Brně | Self-propelled mobile platform |
Family Cites Families (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| DE3147630A1 (en) * | 1981-12-02 | 1983-06-09 | Dango & Dienenthal Maschinenbau GmbH, 5900 Siegen | Manipulator vehicle capable of movement on floors |
| JP3455999B2 (en) * | 1993-12-20 | 2003-10-14 | 株式会社デンソー | Traveling trolley |
| CN2202021Y (en) * | 1994-06-22 | 1995-06-28 | 哈尔滨工业大学 | Robert moving mechanism in tube with stright moving wheels |
| DE19948486A1 (en) * | 1999-10-07 | 2001-08-23 | Joachim Lueckel | Device for positioning of body has facility whereby body is driven by one or more wheels and steering angle is adjustable via driving torque which is provided by motor by means of corresponding control |
| JP2003039349A (en) * | 2001-07-25 | 2003-02-13 | Komatsu Ltd | Traveling control device of traveling robot |
| JP2004017791A (en) * | 2002-06-17 | 2004-01-22 | Hitachi Ltd | Traveling object |
| CN1289268C (en) * | 2003-11-18 | 2006-12-13 | 中国科学院自动化研究所 | Driving structure and driving method of mobile orbot platform |
| CN2717789Y (en) * | 2004-06-04 | 2005-08-17 | 山东鲁能智能技术有限公司 | Four-wheel driving wheel type robot moving vehicle |
-
2006
- 2006-06-01 CN CNB2006100271973A patent/CN100382935C/en not_active Expired - Fee Related
Cited By (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101850727A (en) * | 2010-02-26 | 2010-10-06 | 湖南山河智能机械股份有限公司 | Remote control wheel type mobile robot platform |
| CN103273476A (en) * | 2013-04-27 | 2013-09-04 | 国家电网公司 | Relay protection room inspection tour robot |
| CN108227530A (en) * | 2018-01-08 | 2018-06-29 | 浙江立石机器人技术有限公司 | A kind of kinetic control system and control method |
| CN108372502A (en) * | 2018-01-08 | 2018-08-07 | 浙江立石机器人技术有限公司 | A kind of robot movement-control system and control method |
| CN108972588A (en) * | 2018-08-29 | 2018-12-11 | 上海常仁信息科技有限公司 | Intelligence backtracks the robot of charging |
| CN108972588B (en) * | 2018-08-29 | 2022-03-11 | 付小芹 | Robot capable of intelligently finding back to charge |
| CN109440699A (en) * | 2018-12-07 | 2019-03-08 | 长沙中联重科环境产业有限公司 | Environmental sanitation is intelligently clean to sweep Work robot control system and cleaning machine |
| WO2020114019A1 (en) * | 2018-12-07 | 2020-06-11 | 长沙中联重科环境产业有限公司 | Sanitation intelligent cleaning and sweeping operation robot control system and cleaning machinery |
| CN109521776A (en) * | 2018-12-31 | 2019-03-26 | 天合光能股份有限公司 | Chassis control system of intelligent robot |
Also Published As
| Publication number | Publication date |
|---|---|
| CN100382935C (en) | 2008-04-23 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN100382935C (en) | Driving and reversing gear of robot moving platform | |
| CN102486648B (en) | Autonomic mobile robot platform | |
| CN101428653A (en) | Driving and steering mechanism of robot moving platform | |
| CN1289268C (en) | Driving structure and driving method of mobile orbot platform | |
| CN206466013U (en) | A kind of automatic transportation omni-directional moving platform | |
| CN1644328A (en) | Small crawler leg composite movable robot mechanism | |
| CN106853843A (en) | A kind of achievable synchronous omni-directional moving platform for turning to | |
| CN106639443B (en) | A kind of AGV trolley that omni-directional drive turns to | |
| CN204546556U (en) | The parallel steering wheel of double freedom based on differential gear train | |
| CN101428655A (en) | Wheeled mobile device for foot for humanoid robot, polypodia walking vehicle | |
| CN109624678A (en) | A kind of low-mounting height heavy duty steering wheel system | |
| CN108715190B (en) | Rotary wheel-track conversion robot | |
| CN106364669A (en) | Lead screw-shifting fork type electromechanical servo mechanism | |
| CN111217068B (en) | Double-station four-way shuttle for grain storage | |
| Fu-Cai et al. | Design of cleaning robot for swimming pools | |
| CN208592849U (en) | A kind of seven axis joint robots based on hollow driver | |
| CN205068155U (en) | Wheeled mobile robot motion control system | |
| CN108403319A (en) | A kind of omnidirectional's electric wheelchair control system based on three-dimensional Hall control stick | |
| CN103640496A (en) | 8 Mecanum wheel heavy-load synergy drive omni-directional mobile platform | |
| CN108560979A (en) | A kind of comb-tooth-type numerical control carrier | |
| CN2657878Y (en) | Drive struction of platform for moving robot | |
| CN102642572B (en) | Duplex triangle connecting frame variable configuration crawler-type obstacle-crossing mechanism | |
| CN209095546U (en) | A kind of omni-directional moving mechanism having obstacle crossing function and robot system | |
| CN216784586U (en) | Backpack bidirectional material taking AGV | |
| Wang et al. | Research on a kind of leg-wheel stair-climbing wheelchair |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| C14 | Grant of patent or utility model | ||
| GR01 | Patent grant | ||
| C17 | Cessation of patent right | ||
| CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20080423 Termination date: 20110601 |