CN105137984A - Double-core intermediate speed four-wheel mini mouse spurting controller - Google Patents
Double-core intermediate speed four-wheel mini mouse spurting controller Download PDFInfo
- Publication number
- CN105137984A CN105137984A CN201510521113.0A CN201510521113A CN105137984A CN 105137984 A CN105137984 A CN 105137984A CN 201510521113 A CN201510521113 A CN 201510521113A CN 105137984 A CN105137984 A CN 105137984A
- Authority
- CN
- China
- Prior art keywords
- motor
- sensor
- slight mouse
- controller
- stm32f407
- 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
Abstract
The invention discloses a Double-core intermediate speed four-wheel mini mouse spurting controller, comprising a main board, and a battery, a first sensor S1, a second sensor S2, a third sensor S5, a fourth sensor S6, a first motor X, a second motor Y, a third motor R, a fourth motor Z, a fifth motor M, a three-axis gyroscope G1, a three-axis accelerometer A1, and a vacuum device, which are arranged on the main board. Through above arrangement, the double-core high-speed four-wheel mini mouse controller can perform monitoring and operation on the mini mouse operation state all the time, and utilizes four sensors to detect, which reduces the interference and accurately monitors the surrounding environment. Besides, the invention corrects the moving posture according to the moving state, anew distributes torque and distributes more torques to the driving wheel which is not in stall, enables the system to quickly get out of the unstable state and automatically regulates the absorption of the vacuum device to the ground and completely eliminates the slipping of the mini mouse exploring in the complicated maze.
Description
Technical field
The present invention relates to the automatic control system of a kind of mouse (PICOMOUSE) slightly, belong to minisize maze robot field.
Background technology
Micro computer mouse is a kind of Intelligent walking robot using embedded microcontroller, sensor and electromechanical movement parts to form, abroad contest nearly 30 years, and it often adopts two wheel constructions, two-wheeled micro computer mouse two-dimensional structure as shown in Figure 1.Micro computer mouse can in different " labyrinth " automatic Memory and selecting paths, adopting corresponding algorithm, arrive set destination rapidly, is the one in the labyrinth that solves of micro computer mouse in Fig. 2.
Along with the continuous progress of microelectric technique, Computer Control Technology, external expert solves micro computer mouse and proposes one on the technical foundation in labyrinth and have more challenging maze robot---mouse slightly, in order to strengthen labyrinth complexity and solve the difficulty in labyrinth, labyrinth retaining wall becomes 90mm by original 180mm, original labyrinth becomes 32*32 lattice by 16*16 lattice, and new labyrinth two-dimensional structure as shown in Figure 3.Power supply is once open, slight mouse whole process relies on self-contained sensor self-navigation completely, and solve the various complex mazes be made up of 1024 maze lattices, an optimal path arriving target setting point can be found from starting point fast, then make a spurt terminal with the fastest speed.As the self-service navigation intelligent robot of one, because labyrinth information can be inputted to controller by wireless device, slight mouse or micro computer mouse match international rule refusal use wireless device, explore in order to slight mouse or micro computer mouse can be obtained, information after spurt, can only be deposited fast by algorithm and store its walking information, after finishing the work, read storage information by interfaces such as 232 serial ports of controller or USB.
Slight mouse will judge the environment of surrounding the moment in labyrinth in spurt process, then communicate a parameter to controller, carries out spurt campaign by controller repetitive control its accurate acceleration and deceleration in the grid of labyrinth.An outstanding slight mouse must possess good perception, has good locomotor activity, outstanding intelligent algorithm, otherwise cannot complete spurt task.Slight mouse labyrinth spurt technological synthesis multi-subject knowledge, for promoting the manipulative ability of students, team collaboration's ability and innovation ability, promote that the scope of one's knowledge of the digestion of student classroom knowledge and expansion student is all very helpful, and slightly mouse labyrinth spurt technology carry out the talent that can cultivate large quantities of association area, and then promote technical development and the industrialization process of association area.
It is international emerging a special kind of skill that slight mouse solves labyrinth, and the complicacy of the higher and labyrinth design of the difficulty due to slight mouse labyrinth spurt technology, causes the domestic unit also not researching and developing this robot.If think that slight mouse is the simple copy of micro computer mouse, design slight mouse according to micro computer mouse technology, find that the slight mouse designed exists following point in practice:
1, owing to solving rolling up of labyrinth number, original micro computer mouse solves maze technique and cannot be used for slight mouse and solve existing complex maze, cannot provide a best spurt path for sound lunge.
2, because the size of slight mouse significantly reduces compared to the size of micro computer mouse, if often there is the situation that sensor disturbs mutually when mouse adopts six of micro computer mouse in Fig. 1 groups of sensors to make slight mouse secondary upgrade complex maze slightly, cause slight mouse to be read when sound lunge and upgrade labyrinth information failure.
3, the skid level on ground, adaptation labyrinth that can only be passive based on wheeled slight mouse, along with the raising of slight mouse dash speed, its skidding probability also greatly increases, and causes solving labyrinth failure.
4, due to the employing of micro computer mouse servo-drive system is all more rudimentary algorithm, if directly these algorithm covers are used on slight mouse, make the spurt of slight mouse in the middle of labyrinth generally all will spend the longer time, this makes cannot win victory in real contest.
5, due to the minimizing of labyrinth retaining wall size, the distance that slight mouse is run compared to the single lattice of micro computer mouse reduces, the frequently braking of slight mouse in sound lunge process and startup have increased the weight of the workload of single-chip microcomputer, and single single-chip microcomputer cannot meet the requirement that slight mouse fast sprint starts and stops.
6, owing to being subject to single-chip microcomputer capacity impact, existing micro computer mouse substantially all only has two power drive wheels, adopts two wheel guide robot mode to travel, system is made to require higher to the servo of diaxon, particularly during linear accelerating spurt navigation, requirement speed and acceleration will be pursued strict consistent, otherwise line navigation will be failed, existing micro computer mouse be directly used in slight mouse and easily cause slight mouse to occur hitting the phenomenon generation of wall.
7, for two-wheel drive micro computer mouse General Requirements two motor PWM control signals driving it to move want synchronous, the single single-chip microcomputer servo-drive system of restriction by computing power is difficult to meet this condition, therefore direct single single-chip microcomputer servo techniques cover is used on slight mouse, accurately walking is difficult on center line when slight mouse is made a spurt on straight way, be easy to when sound lunge bump against left and right labyrinth retaining wall, cause mission failure of making a spurt.
8, two wheel drive systems when accelerating due to center of gravity after move, make anterior light, even if slight mouse also can be skidded on good road surface, likely cause the phenomenon of hitting wall to occur, be unfavorable at a high speed the development that mouse is slightly made a spurt.
If 9, two-wheeled designs improper meeting and causes the front inclined or center of gravity lateral deviation of center of gravity, the normal pressure that will cause driving wheel bears when polarization often travels before center of gravity reduces, and makes to be more prone to during motion skid, also more easily wander off, and causes navigating unsuccessfully.Center of gravity lateral deviation is by different for the normal pressure causing two driving wheels to bear, and when starting fast, two-wheeled skid level is inconsistent, and moment, during turning, the wheel that wherein normal pressure is little may skid, and causes cornering difficulties with regard to off-track.
10, two power wheels are adopted to drive, in order to meet acceleration under complex state and deceleration, make the power of single drive motor larger, the space not only taken is larger, and under the state that some relative requirements energy are lower, sometimes cause the phenomenon of " low load with strong power " to occur, be unfavorable for the saving of miniaturization and system energy.
11, slight mouse is when walking in labyrinth, be easy to be subject to external interference, slight mouse is caused to collide labyrinth retaining wall owing to not carrying out compensating in time, in operational process, hit wall situation all motor rotation blockage situation can occur once run into, cause motor immediate current excessive, time serious, burn out motor, finally cannot finish the work.
Summary of the invention
What the object of the invention is solution provides a kind of double-core middling speed four-wheel slight mouse sprint controller by existing Advanced Control Techniques and Dynamic matrix control chip, solves problems problem of the prior art.
The technical solution used in the present invention is:
The slight mouse sprint controller of double-core middling speed four-wheel, comprise mainboard, also comprise battery, first sensor S1, the second sensor S2, the 3rd sensor S5, four-sensor S6, the first motor X, the second motor Y, the 3rd motor R, the 4th motor Z, the 5th motor M, three-axis gyroscope G1, three axis accelerometer A1, vacuum plant, STM32F407 controller and 5 LM629 chips, they are installed on mainboard;
Described STM32F407 processor is electrically connected LM629 chip, described battery, first sensor S1, the second sensor S2, the 3rd sensor S5, four-sensor S6, three-axis gyroscope G1 are all connected with STM32F407 controller signals with three axis accelerometer A1, and 5 LM629 chips are connected with the first motor X, the second motor Y, the 3rd motor R, the 4th motor Z and the 5th motor M signal respectively;
First sensor S1, the second sensor S2, the 3rd sensor S5 and four-sensor S6 be all positioned at mainboard upper surface front end, wherein two signal transmit directions identical with wheel direct of travel, have certain angle between two other signal transmit direction and wheel direct of travel, the elongated surfaces having the search coverage of two of certain angle sensors and mainboard to be provided with the side of wheel between signal transmit direction with wheel direct of travel intersects and search coverage can get around the transmit direction sensor position identical with wheel direct of travel; First motor X, the second motor Y, the 3rd motor R and the 4th motor Z are arranged on both sides in the middle part of mainboard with the four-wheel one_to_one corresponding, wherein two motors that are arranged in slight mouse both sides respectively, two other motor is arranged on both sides, mainboard rear end and makes slight mouse form the composite structure driving and add rear-guard; Described 5th motor M is connected with vacuum plant.
Due to the significantly reduction of slight mouse volume, if still adopt between the structure of micro computer mouse as shown in Figure 1, sensor 2 and 3 and between sensor 4 and 5 and often produce interference mutually, all need the regular hour owing to often organizing sensor collection labyrinth retaining wall parameter simultaneously, increase the weight of the sampling period, cause sample frequency to reduce, extend the processing time of processor STM32F407.Therefore expect improving, as shown in Figure 4, sensor S1, sensor S6 acting in conjunction judge front barricade, sensor S2 judges the existence of its left side barricade, sensor S5 judges the existence of barricade on the right of it, and sensor S2 and sensor S5 cooperate as slight mouse straight dash motion provides navigation foundation simultaneously.Labyrinth retaining wall information is calculated in order to use intelligent algorithm, can correct slight mouse before use, the slight mouse of timing is placed on different set position, labyrinth, sensor S1, sensor S2, the signal that sensor S5 and sensor S6 sends through lateral retaining wall feedback after respectively by sensor S1, sensor S2, sensor S5 and sensor S6 receives (at sensor S1, sensor S2, when sensor S5 and sensor S6 includes infrared emission sensor OPE5594A and infrared remote receiver TSL262, first sensor S1, second sensor S2, the infrared light that the infrared emission sensor OPE5594A of the 3rd sensor S5 and four-sensor S6 launches can be received by the infrared remote receiver TSL262 of correspondence after barricade feedback), as the setting threshold values of current location after reception value via controller calculates, then in spurt process, its labyrinth information is obtained by comparing with these threshold values when mouse uses slightly.
In order to improve stability when the slight mouse of four-wheel is made a spurt in labyrinth further, the present invention adds three-axis gyroscope G1 and three axis accelerometer A1 in slight mouse servo hardware system, just controller has given up original open gyrostatic pattern when turning.Omnidistancely during slight mouse spurt labyrinth open gyroscope and accelerometer, three-axis gyroscope G1 is used for measuring three the rotation directions motions of slight mouse, and three axis accelerometer is used for measuring the acceleration of slight mouse three translation motions.Controller calculates speed and the position data of slight mouse according to the acceleration signal recorded, utilize gyroscope G1 measure in short-term advantage and accelerometer A1 accurately long time stable feature, both combine, obtain stablizing in short-term again can long time stable angle of inclination, with gyroscope survey interior angle change in short-term, acceierometer sensor is used as obliquity sensor and measures inclination angle, and in a Long time scale, the inclination angle that acceleration transducer obtains slowly is mated at the inclination angle forcing gyroscope to obtain.Gyroscope and accelerometer moment record the instantaneous parameters of slight mouse and flow to controller, when the attitude of slight mouse change exceed setting threshold values time, new sampling period just immediately to its position compensation, avoid the generation that slight mouse departs from center phenomenon far away, improve stability during its spurt.
In order to improve stability when slight mouse is made a spurt in labyrinth further, prevent slight mouse from skidding when sound lunge and cause slight mouse labyrinth information errors, the present invention adds DC micromotor M in the hardware system of the slight mouse sprint controller of two-wheeled, concrete can the adopting of vacuum plant comprises vacuum suction apparatus and arranges (other structures can certainly be adopted to realize) with the mode of the micro vacuum sucker being positioned at the slight mouse lower surface of two-wheeled, in slight mouse spurt process, motor M does not stop to aspirate the air in micro vacuum sucker by vacuum suction apparatus, make the external and internal pressure of micro vacuum sucker different thus produce certain negative pressure, slight mouse is made to produce certain absorption affinity to ground, and along with the increase of slight mouse dash speed, micromachine M can regulate vacuum cup to the absorption affinity on ground automatically, increase the friction factor to ground, thoroughly prevent slight mouse sound lunge constantly because of ground skid cause spurt failure phenomenon generation again.
As a further improvement on the present invention: and the difference of embodiment 1 is: the angle between the sensor signal transmit direction of described first sensor S1 and the sensor signal transmit direction of the second sensor S2 be more than or equal to 75 ° and be less than or equal to 90 °, the 3rd sensor S5, four-sensor S6 sensor signal transmit direction between angle be more than or equal to 75 ° and be less than or equal to 90 °.Adopt in this way, the interference between sensor less, measure more accurate.When angle be more than or equal to 75 ° be less than 90 °, and sensor S2 and sensor S5 can accurately measure labyrinth from have barricade to without barricade and without barricade to the change having barricade, sensor S2 and sensor S5 can also accurately measure from have barricade to without barricade change and from without barricade to there being the change of barricade, the sensor signal change of position that barricade changes can capture by controller, then can carry out fine compensation to slight mouse.Then focus on the detection to both sides when angle equals 90 ° and the interference of having stopped between sensor, and can intelligent compensation be carried out.The setting of angle calculates most important for complex maze in a word, if do not have intelligent compensation, slight mouse may produce cumulative errors to make spurt failure in complex maze.
As a further improvement on the present invention: the first motor X, the second motor Y, the 3rd motor R and the 4th motor Z are permanent magnet DC motor, 5th motor M is direct current generator, and two motors be arranged in the first motor X, the second motor Y, the 3rd motor R and the 4th motor Z in the middle part of mainboard are larger than the power of motor of two other motor.Only just start rear-guard (starting two motors controlling trailing wheel) when power demand is higher during use, play power-assisted effect, save power and can be different with ambient conditions and before and after being distributed in by different proportion by demand torque on all wheel by ground, labyrinth, to improve the driveability of slight mouse.
As a further improvement on the present invention: the first motor X, the second motor Y, the 3rd motor R, the 4th motor Z and the 5th motor M be equipped with photoelectric encoder.Photoelectric encoder can export A pulse and B pulse and Z pulse, according to the absolute position of the level recording motor of pulse, be converted into the particular location of slight mouse in labyrinth, it is more accurate to locate.
As a further improvement on the present invention: described mainboard is also provided with the voltage sensor V1, the first current sensor C1, the second current sensor C2, the 3rd current sensor C3 and the 4th current sensor C4 that are connected with STM32F407 controller signals, the first current sensor C1, the second current sensor C2, the 3rd current sensor C3 and the 4th current sensor C4 respectively with the motor one_to_one corresponding of four wheels controlling slight mouse.LM629 is connected with STM32F407 with control line by data line, STM32F407 sends the command value such as position, speed, acceleration to LM629 after external environment is transformed, command value is generated the deviation signal of four axle servo-drive systems by LM629 again in conjunction with the feedback of photoelectric encoder, the first current sensor C1, the second current sensor C2, the 3rd current sensor C3 and the 4th current sensor C4, be that process core produces four axle servo-drive system PWM ripples with LM629, amplify the slight mouse fast sprint of rear drive through drive axle.Adopt STM32F407 in this way to free in the middle of the work of complexity, realize the signal processing algorithm of part and the steering logic of LM629, and response is interrupted, realize data communication and store live signal.
As a further improvement on the present invention: first sensor S1, the second sensor S2, the 3rd sensor S5 and four-sensor S6 include infrared emission sensor OPE5594A and infrared remote receiver TSL262.The infrared light that the infrared emission sensor OPE5594A that first sensor S1, the second sensor S2, the 3rd sensor S5 and four-sensor S6 include launches can be received by the infrared remote receiver TSL262 of correspondence after barricade feedback.
The invention still further relates to the control method of the slight mouse sprint controller of a kind of double-core middling speed four-wheel, comprise the following steps:
1, spurt prepares: slight mouse is placed on labyrinth starting point, turning on the power switch STM32F407 controller instantaneously can to detection battery supply, if low voltage voltage inductor V1 by work and point out alerting signal point out charging, if voltage is normal, slight mouse is waited for the spurt order that controller sends and recalls the optimum labyrinth after exploring;
2, spurt discriminating direction: after receiving spurt order, first sensor S1 and four-sensor S6 can judge the environment in front, define and do not have barricade to enter range of movement, interrupt request will be sent to STM32F407 controller as there is barricade, STM32F407 controller can do very first time response to interruption, then control first motor X is forbidden, second motor Y, 4 LM629 chip operations of the 3rd motor R and the 4th motor Z, block the first motor X, second motor Y, the PWM drive singal of the 3rd motor R and the 4th motor Z, it is made to be still in original place, then secondary judges that front information is determined in labyrinth, prevent information from judging by accident, if do not have barricade to enter the range of movement in front, slight mouse will open reset circuit, transfer normal labyrinth information, prepare to make a spurt normally,
3, spurt controls: when receiving the moment of slight mouse spurt, open unlatching the 5th motor M, three-axis gyroscope G1, three axis accelerometer A1 and vacuum suction apparatus, vacuum suction apparatus make slight mouse over the ground mask have certain absorption affinity, three-axis gyroscope G1, three axis accelerometer A1 carries out to slight mouse direction of travel the generation departing from center phenomenon when auxiliary corrective avoids the spurt of slight mouse, first sensor S1, second sensor S2, 3rd sensor S5 and four-sensor S6 judge that environmental parameter is also given STM32F407 controller by environment around, and STM32F407 requires to be converted into according to four axles walking servo control unit speed and acceleration the distance that slight mouse will run these environmental parameters, speed and acceleration command value and with LM629 chip communication, by LM629 chip according to these parameters again in conjunction with the photoelectric encoder of motor, first current sensor C1, second inductor C2, the feedback of the 3rd inductor C3 and the 4th inductor C4 generates driving first motor X, second motor Y, the PWM ripple of the 3rd motor R and the 4th motor Z, STM32F407 controller requires control LM629 chip according to external environment condition and then controls the first motor X, second motor Y, two in 3rd motor R and the 4th motor Z or all work, PWM ripple amplifies rear drive two motors through drive axle or four motors make slight mouse move, complete whole accelerator until reach spurt setting speed, STM32F407 controller detects three-axis gyroscope G1 in real time, three axis accelerometer A1 and the first motor X, second motor Y, 3rd motor R, 4th motor Z, adjusts according to the absorption affinity of slight speed to vacuum suction apparatus,
4, to turn to and straight movement control: first sensor S1, the second sensor S2, the 3rd sensor S5 and four-sensor S6 judge that environmental parameter is also given STM32F407 controller by environment around, if have labyrinth retaining wall to enter the range of movement in front in slight mouse forward movement, then judge whether left and right has barricade, if at least side is without barricade, if all there is barricade both sides of turning, turns around; Have in some lattice rectilinear coordinates in slight mouse forward movement display front and there is no barricade, judge that the range of movement in front does not stop that then mouse is by its present coordinate of storage slightly, processor passes to STM32F407 the location parameter of some lattice that travel forward, then four LM629 chip controls first motor X, the second motor Y, the 3rd motor R and the 4th motor Z make slight mouse thrust forward, and gyroscope G1, accelerometer A1 can record the distance of movement and flow to STM32F407 controller in the moment;
5, position judgment: when slight mouse controls the some lattice of lower motion apart from when arriving new address, controller will upgrade its coordinate and is and judges that its coordinate is terminal, its coordinate is upgraded if not by continuation, if words notification controller to have made a spurt target, then arranging makes a return voyage explores mark, and slight mouse prepares return and explores.
As a further improvement on the present invention, return heuristic process is as follows: when slight mouse enters labyrinth return exploration, first sensor S1, second sensor S2, 3rd sensor S5 and four-sensor S6 is by work, and give STM32F407 controller the photosignal reflected, controller gives LM629 chip after judging, communication is carried out with STM32F407 controller by after the computing of LM629 chip, then send control signal to the first motor X by STM32F407 controller, second motor Y, 3rd motor R and the 4th motor Z determines, if enter the region searched for will advance fast, STM32F407 can strengthen the dutycycle controlling motor, with quickly through known region, reduce secondary and explore the time, if unknown return area then adopts normal speed to search for, in motion process, the controller moment detects slight mouse running status and in real time adjustment motor M carries out friction force adjustment and the moment upgrades its coordinate and judges that its coordinate is starting point,
Turn to and comprise error correction step with straight movement control step, error calibration method is as follows: mouse first sensor S1, the second sensor S2, the 3rd sensor S5 and the labyrinth retaining wall of four-sensor S6 moment to surrounding detect slightly, if signal there occurs the transition of bigger numerical, STM32F407 according to slight mouse current operating conditions fine compensation, can thoroughly eliminate slight mouse error accumulative in complex maze;
The method adopted when turning to: the air line distance travelling one section before proceeding to, carries out two sections according to certain radian when proceeding to and turns to, produce rear traveling one section of air line distance, during turning, first STM32F407 is converted into different speed parameters and acceleration parameter then according to state of ground enable two or four LM629 proceeding to the difference of front operating range according to spurt condition, and command value is transferred to the LM629 of control, LM629 can according to these parameters again in conjunction with photoelectric encoder, first current sensor C1, second current sensor C2, the feedback of the 3rd current sensor C3 and the 4th current sensor C4 generates the PWM waveform and direction that drive and take turns all around, control the first motor X, second motor Y, 3rd motor R and the 4th motor Z realizes turning to.
The beneficial effect that the present invention has is:
1, in motion process, take into full account battery effect in this system, the controller moment is all monitoring and computing the running status of slight mouse, and by the first current sensor C1, second current sensor C2, 3rd current sensor C3 and the 4th current sensor C4 carries out current feedback, avoid the generation of big current, so fundamentally solve the impact of big current to battery, avoid the generation of the battery overaging phenomenon caused due to heavy-current discharge, and the SOC of moment display lithium ion battery, be conducive to the energy state of electrolytic cell, when battery power status is lower, battery can be changed before spurt prerequisite, thus decrease battery the mistake of sound lunge is disturbed.
2, adopt first sensor S1, the second sensor S2, the 3rd sensor S5 and four-sensor S6 solve maze technique and substitute original six groups of sensors and solve the interference that maze technique not only reduces each sensor group in system, also improve labyrinth retaining wall frequency acquisition, be conducive to the arithmetic speed of raising system.
3, in order to fully improve stability and the driveability of slight mouse system, and take into account the mid-advantage turned to of two-wheeled, the present invention has given up traditional real-time 4 wheel driven structure, + the composite structure of rear-guard is driven: the power of motor power of mid-driving is larger in employing, two each and every one powers of motor of rearmounted driving are less, only just start rear-guard when power demand is higher, play power-assisted effect.Owing to adopting four-wheel drive technology, slight mouse front and back wheel is all dynamic, can be different with ambient conditions and be distributed on all wheels in front and back by demand torque by different proportion, to improve the ability to sprint of slight mouse by ground, labyrinth.
4, time sharing is realized as required.Under normal running environment, because demand power is not very large, in two motors driving just can meet, in order to save energy, slight mouse generally can adopt release trailing wheel, adopts the mode of mid-wheel drive; And once run into the situations such as the wheel stall that needs the more or slight mouse of sound lunge, road dust, STM32F407 automatically can detect to exist side by side and distribute to rearmounted two power-assisted driving wheels by slight mouse demand torque, the servocontrol of motor M is changed with Time Controller, slight mouse system is switched to four-wheel drive state naturally, enhances the adhesion of slight mouse and handling.
5, in adopting ,+compound four-wheel drive the mode of rear-guard is driven, when needs accelerate spurt, power is assigned to four motors, once power wheel because ground, physical construction etc. cause ground away from keyboard, STM32F407 can redistribute moment of torsion, more torque distribution on the driving wheel of non-stall, makes system hightail non-steady state, come back to four axle dynamic equilibrium states, make slight mouse have better straight dash ability.
6, when mouse spurt turns to slightly, in order to ensure the stability rotated, adopting two mid-driving wheels to realize turning, and discharging two rearmounted power-assisted driving wheels;
If 7, four-wheel slight mouse system design when normal spurt improper cause center of gravity before partially, reduce causing the normal pressure that rear side driving wheel bears, the power that STM32F407 can adjust rear side automatically distributes, and makes system be in a kind of new equilibrium state, prevents slight mouse from skidding.
If 8, four-wheel slight mouse system designs when normal spurt and improperly causes center of gravity lateral deviation, the normal pressure causing a side drive wheel is born is reduced, the power that STM32F407 can adjust this side automatically distributes, and makes system be in a kind of new equilibrium state, prevents slight mouse from skidding.
9, in slight mouse walking process, controller detects its situation such as the speed of travel, ground in real time, and by regulating the servocontrol of motor M effectively to regulate vacuum plant to the absorption affinity on ground, add the friction factor on slight mouse and ground, completely eliminate the generation of skidding during slight mouse sound lunge.
10, gyroscope G1 and accelerometer A1 is introduced in this slight mouse system, dynamic parameter when slight mouse can be accurately measured, and the velocity magnitude of slight mouse and the independence in direction control when realizing existing slight mouse sound lunge, realize omnidistance navigation and second compensation, be conducive to the stability and the dynamic property that improve slight mouse.
11, by the servocontrol of five direct current generators of the slight mouse of LM629 process, make control fairly simple, substantially increase arithmetic speed, solve scm software and run slower bottleneck, shorten the construction cycle short, and program transportability ability is strong.
12, the data adopting LM629 process a large amount of due to this controller and algorithm, and taken into full account interference source around, STM32F4079 is solved workload from five heavy axle servo-drive systems and frees, effectively prevent " race flies " of program, antijamming capability strengthens greatly.
13, in slight mouse operational process, STM32F407 can carry out on-line identification to the torque of the first motor X, the second motor Y, the 3rd motor R and the 4th motor Z and utilize the relation of motor torque and electric current to compensate, and decreases the impact of motor torque shake on slight mouse fast sprint.
14, owing to having memory function, this makes slight mouse can transfer the labyrinth information explored easily, can optimize the path of secondary spurt, reduces the spurt time.
15, the present invention realizes full SMD components material substantially, not only saves control panel and takes up room, and be conducive to alleviating of volume and weight, is conducive to the stability and the dynamic property that improve slight mouse.
Accompanying drawing explanation
Fig. 1 is two wheel drive micro computer mouse X-Y schemes.
Fig. 2 is micro computer mouse 16*16 labyrinth schematic diagram.
Fig. 3 is slight mouse 32*32 labyrinth schematic diagram.
Fig. 4 is four-wheel slight mouse sprint controller flow chart
Fig. 5 is four eyed slight mouse two dimension schematic diagram.
Fig. 6 is theory diagram of the present invention.
Fig. 7 is slight mouse Velocity-time ladder diagram.
Fig. 8 is slight mouse forward straight dash schematic diagram, and in figure, leftmost figure demonstrates two wall navigation mode, and the right two figure is single wall navigation mode, they are respectively left single wall navigation mode and right single wall navigation mode respectively.
Fig. 9 is slight mouse reverse linear spurt schematic diagram, and in figure, leftmost figure demonstrates two wall navigation mode, and the right two figure is single wall navigation mode, they are respectively left single wall navigation mode and right single wall navigation mode respectively.
Figure 10 is slight mouse right-hand rotation spurt schematic diagram.
Figure 11 is slight mouse left-hand rotation spurt schematic diagram.
Embodiment
Below in conjunction with accompanying drawing, the present invention is described further.
For the ease of explaining, refer to slight mouse midline, slightly mouse rear portion in the middle part of slight mouse and refer to the slight mouse side away from first sensor S1, the second sensor S2, the 3rd sensor S5 and four-sensor S6, particular location is with reference to accompanying drawing.Slight mouse lower surface refers to the face contrary with the face being provided with the place such as battery, first sensor S1, the second sensor S2, the 3rd sensor S5, four-sensor S6.First motor X, the second motor Y, the 3rd motor R, the 4th motor Z take turns with X respectively, Y takes turns, R takes turns, Z takes turns corresponding, X wheel and Z wheel are positioned on the right side of slight mouse, Y wheel and R wheel are positioned at the left side of slight mouse, and X wheel and Y wheel are positioned in the middle part of slight mouse, R takes turns and Z takes turns and is positioned at slight mouse rear portion.5th motor M refers to the motor corresponding with vacuum plant, motor X, motor Y, motor R, motor Z and motor M are respectively writing a Chinese character in simplified form of the first motor X, the second motor Y and the 3rd motor M, and sensor S1, sensor S2, sensor S5 and sensor S6 are respectively first sensor S1, the second sensor S2, the writing a Chinese character in simplified form of the 3rd sensor S5 and four-sensor S6.Current sensor C1, current sensor C2, current sensor C3 and current sensor C4 are respectively the first current sensor C1, the second current sensor C2, the 3rd current sensor C3 and the 4th current sensor C4 and write a Chinese character in simplified form.X-axis and Y-axis refer to X-axis in figure shown in 3 and Y-axis, for convenience of description, give concrete starting point coordinate and terminal point coordinate, such as starting point coordinate (0,0), such as terminal point coordinate (F, F), (F, 10), (10, F), (10,10), may change in actual applications.The time slight mouse both sides that single wall navigation mode refers to only have wherein side to have the pattern entered during barricade, and single wall navigation mode is divided into left single wall navigation mode and right single wall navigation mode; All there is the pattern entered during barricade the time slight mouse both sides that two wall navigation mode refers to.These definition, only in order to those skilled in the art can understand teachings herein, should not be considered as the restriction to protection domain or using method.
When the present invention uses, first slight mouse is placed on labyrinth starting point, under power-on state, slight mouse is introduced into self-locking state, and first controller opens motor M, automatically the friction coefficient on the slight mouse of adjustment and ground.Slight mouse relies on first sensor S1, second sensor S2, 3rd sensor S5 and four-sensor S6 according to actual navigational environment transformation parameter to STM32F407, STM32F407 is converted into the slight mouse distance that will run of four-wheel all around these parameters, speed and acceleration command value, STM32F407 then with LM629 communication, LM629 according to these parameters again in conjunction with photoelectric encoder, first current sensor C1, second current sensor C2, the feedback of the 3rd current sensor C3 and the 4th current sensor C4 generates the pwm control signal of driving four individual motor, four axle drive singal amplify rear drive motor X through drive axle, motor Y, motor Z, motor R travels forward, in motion process, controller is in real time to the slight mouse speed of travel, the situations such as ground detect, and by regulating the servocontrol of motor M effectively to regulate vacuum cup to the absorption affinity on ground, add the stability during spurt of slight mouse, and process data communication to STM32F407, the follow-up running status of process is continued by STM32F407.
With reference to accompanying drawing, the functional realiey that the application is concrete is as follows:
1) before slight mouse does not receive spurt order, after holding electricity, controller can detect battery supply, if alarm charges by low pressure.If voltage normally generally can wait at starting point coordinate (0,0) the spurt order that controller sends, and recalls the optimum labyrinth after exploring.First controller opens vacuum draw motor M, first micro vacuum sucker is aspirated by aspirator, make vacuum cup over the ground mask have certain absorption affinity, controller also detects in real time, if ground is unclean, system can strengthen vacuum cup to the absorption affinity on ground by self-regulation motor M, increases the friction factor on when slight mouse is made a spurt and ground.Once after receiving spurt order, slight mouse to be sprinted for the line (F, F), (F, 10), (10, F), (10,10) from the off fast along optimal path.
2) spurt direction is misplaced in order to prevent after mouse receives task slightly, sensor S1, the S6 in its front and can judge the environment in front, define and do not have barricade to enter range of movement, interrupt request will be sent to STM32F407 as there is barricade, STM32F407 can do very first time response to interruption, then the LM629 work controlling four-wheel is all around forbidden, block the PWM drive singal of the motor X of slight mouse, motor Y, motor Z and motor R, it is made to be still in original place, then secondary judges that front information is determined in labyrinth, prevents information from judging by accident, if do not have barricade to enter the range of movement in front, slight mouse will open reset circuit, transfer normal labyrinth information, preparation is made a spurt normally, in slight mouse spurt process, controller is in real time to the slight mouse speed of travel, the situations such as ground detect, and by regulating the servocontrol of motor M effectively to regulate vacuum cup to the adsorptive power on ground, gyroscope G1 and its instantaneous acceleration of accelerometer A1 real time record in slight mouse fast sprint process, speed and position, when slight mouse fast sprint has departed from setting center, within the new sampling period, STM32F407 regenerates the instruction set-point of three closed loop servo systems according to the state of current S2 and is transferred to LM629, then LM629 is again in conjunction with photoelectric encoder and current sensor C1, C2, C3, the PWM ripple input of the feedback fine setting motor of C4, four axle servo-drive systems start to carry out real-Time Compensation to adjust the attitude of slight mouse, it is made to come back to setting center.
3) spurt moment is slightly being started, sensor S1, S2, S5, S6(tetra-infrared light that independently infrared transmitting tube OPE5594A sends is converted into the information in labyrinth around after four infrared remote receiver TSL262 accept) judge environment around and give STM32F407, then by the instruction set-point of STM32F407 according to spurt labyrinth information formation speed-time motion ladder diagram, this trapezoidal area comprised is exactly the distance that slight mouse motor will run.Then the enable LM629 of STM32F407, with LM629 communication, is generated the PWM ripple of drive motor X, motor Y, motor Z and motor R again in conjunction with the feedback of photoelectric encoder and current sensor C1, C2, C3, C4 according to these parameters by LM629.PWM ripple, through drive axle rear drive motor X, motor Y, motor Z and motor R, completes whole accelerator until reach spurt setting speed.
4) slight mouse in Y-axis forward forward fast sprint process or oppositely forward in fast sprint process, if showing in the information of labyrinth under there are Z lattice rectilinear coordinates in front does not have barricade to enter the range of movement in front, slight mouse is by its present coordinate (X of storage, Y), processor passes to STM32F407 the location parameter of the Z lattice that travel forward, then STM32F407 is converted into speed parameter and acceleration parameter and enable four LM629 this parameter according to the requirement that various spurt condition is different, again in conjunction with photoelectric encoder, current sensor C1, the feedback of C2 generates drive motor X, motor Y, the PWM ripple of motor Z and motor R, PWM ripple amplifies rear drive motor X through drive axle, motor Y, motor Z, motor R travels forward, motor X, motor Y, motor Z, the photoelectric encoder of motor R and gyroscope G1, accelerometer A1 can record the distance of movement and flows to controller in the moment, in spurt process, sensor S2 and S5 can judge the barricade of left and right, and record stores current labyrinth retaining wall information, slight mouse enters single wall navigation mode or two wall navigation mode according to the labyrinth information of working direction left and right barricade, then gyroscope G1 and accelerometer A1 measures the transient motion acceleration of slight mouse in real time, speed and position also send controller to, when slight mouse fast sprint has departed from setting center, in the new sampling period, controller borrows gyroscope G1 and accelerometer A1 to start to carry out real-Time Compensation according to the deviation leaving center, the PWM ripple input of fine setting motor, by this mode can accurate adjustment spurt time the attitude of slight mouse and position, it is made to come back to setting center, when slight mouse moves the Z lattice distance new address of arrival under the control of gyroscope G1 and accelerometer A1, it is (X that controller will upgrade its coordinate, or (X Y+Z), Y-Z), under the prerequisite of Y+Z<1F or under the prerequisite of Y-Z<1F, judge that its coordinate is (F, F), (F, 10), (10, F), (10,10) one of them, its coordinate is upgraded if not by continuation, if words notification controller to have made a spurt target, then put exploration of making a return voyage and be masked as 1, slight mouse prepares return and explores.
5) if having labyrinth retaining wall to enter the range of movement in front slight mouse in Y-axis forward movement, and now in the information of labyrinth left have barricade and without during barricade or left, without barricade, there is a barricade right in right time, slight mouse will store now coordinate (X, Y), then the curvilinear motion track shown in Figure 10 or Figure 11 is entered: in order to make turning more steady, system adopts four sections of methods to realize turning: proceed to front linear correction distance (being labeled as Leading in figure), proceed to and correct radian (being labeled as ARC1 in figure), produce and correct radian (being labeled as ARC2 in figure), produce rear linear correction distance (being labeled as Passing in figure).
When right spurt is turned or when left spurt is turned, first STM32F407 is converted into speed parameter and acceleration parameter then enable four LM629 all around distance Leading very short for walking straight line according to the requirement that various spurt condition is different, and this setting command value is transferred to the LM629 that control takes turns all around, the trapezoidal motion generator of LM629 inside can according to these parameters again in conjunction with photoelectric encoder and current sensor C1, C2, C3, the feedback of C4 generates the PWM waveform and direction that drive and take turns all around, control motor X, motor Y, motor Z and motor R rapid movement forward, slight mouse along in current maze lattice thrust forward process, controller effectively regulates vacuum cup to the adsorptive power on ground according to peripheral sensor by regulating the servocontrol of motor M in real time, sensor S2 can judge left barricade, and record stores current labyrinth retaining wall information, slight mouse enters single wall navigation mode according to the labyrinth information of the left barricade of working direction, when arriving set objective, sensor reference value R90_FrontWallRef or L90_FrontWallRef starts working, and prevents external interference from starting to do error compensation.After error compensation terminates, in order to smooth turning, controller forbids that two-wheeled rear-guard LM629 works, and systematic evaluation is to the mid-driving condition of two-wheeled.
First STM32F407 is converted into speed parameter and acceleration parameter radian ARC1 according to the requirement that various spurt condition is different and is transferred to the LM629 controlling left and right wheels, then LM629 generates in conjunction with the feedback of photoelectric encoder and current sensor C1, C2 the PWM ripple driving direct current generator to move again, and PWM ripple is promoted slight pindone and becomes turning spurt after being amplified by drive axle.In slight mouse turning spurt process, sensor S1, S2, S5, S6 close, and system enters gyroscope inertial navigation pattern.Gyroscope G1 and its instantaneous acceleration of accelerometer A1 real time record, speed and position in slight mouse fast sprint process, and pass through speed and the angle contrast of anomalous integral quadratic integral and desired location, adjusted by the regulator of LM629 inside, when slight mouse fast sprint has departed from desired location, within the new sampling period, system is according to the PWM ripple input of deviation size fine setting motor, diaxon servo-drive system starts to carry out real-Time Compensation to adjust the attitude of slight mouse, makes it complete radian ARC1;
Then STM32F407 is converted into speed parameter and acceleration parameter radian ARC2 according to the requirement that various spurt condition is different and is transferred to the LM629 controlling left and right wheels, then LM629 generates in conjunction with the feedback of photoelectric encoder and current sensor C1, C2 the PWM ripple driving direct current generator to move again, and PWM ripple is promoted slight pindone and becomes turning spurt after being amplified by drive axle.In slight mouse turning spurt process, system enters gyroscope inertial navigation pattern.When slight mouse fast sprint has departed from desired location, within the new sampling period, system is according to the PWM ripple input of deviation size fine setting motor, and diaxon servo-drive system starts to carry out real-Time Compensation to adjust the attitude of slight mouse, makes it complete radian ARC2; ;
When after arrival set objective, system turn on sensor S2, controller is converted into speed parameter and acceleration parameter distance Passing very short for straight line moving according to the requirement that various spurt condition is different and is transferred to four LM629 controlling left and right wheels, then LM629 generates in conjunction with the feedback of photoelectric encoder and current sensor C1, C2, C3, C4 the PWM ripple driving direct current generator motion again, and PWM ripple promotes slight mouse thrust forward after being amplified by drive axle.Sensor S2 detects left labyrinth retaining wall, and record stores current labyrinth retaining wall information, according to the labyrinth information of left barricade or barricade again, slight mouse determines that it enters single wall navigation mode.The geometric locus motion of whole right-hand bend is completed after arriving set objective.Now will upgrade its coordinate for (X+1, Y) or (X-1, Y), under the prerequisite of X+1<1F or under the prerequisite of X-1<1F, judge that its coordinate is (F, F), (F, 10), (10, F), (10,10) one of them, perform new spurt order if not by continuing, and if it is notification controller has been made a spurt terminal, then put exploration of making a return voyage and be masked as 1, slight mouse prepares return and explores.
6) when slight mouse spurt arrives (F, F), (F, 10), (10, F), (10,10) can prepare the return after making a spurt after explores to search more excellent path, controller can recall its labyrinth information stored, and then calculates other optimal path that may exist, and then return starts to enter one that wherein thinks optimum.
7) when slight mouse enters labyrinth return exploration, sensor S1, S2, S5, S6 of its navigation are by work, and give STM32F407 the photosignal reflected, LM629 is given after STM32F407 judges, communication is carried out with STM32F407 by after LM629 computing, then control signal is sent to determine to the motor X of navigation, motor Y, motor Z and motor R by controller: will advance fast if enter the region searched for, STM32F407 can strengthen the dutycycle controlling motor, with quickly through known region, reduce secondary and explore the time; If unknown return area then adopts normal speed to search for.In motion process, the controller moment is detected slight mouse running status and adjusts the servocontrol of motor M in real time, and the moment upgrades its coordinate (X, and judge its coordinate whether (0,0) Y), if words put exploration of making a return voyage and be masked as 0, slight mouse enters the sprint stage, and juxtaposition spurt is masked as 1.
8) in order to the coordinate calculating accurately when making a spurt of slight mouse can be realized, sensor S2 and S5 about slight mouse can detect the labyrinth retaining wall of surrounding and pillar in the moment, if sensor S2 or S5 finds that sensor signal there occurs the transition of bigger numerical, then illustrate that slight mouse enters from having labyrinth retaining wall to the change without labyrinth retaining wall (or from without labyrinth retaining wall to there being labyrinth retaining wall) state, STM32F407 according to slight mouse current operating conditions fine compensation, can thoroughly eliminate the error added up when slight mouse is explored in complex maze.
9) in slight mouse spurt process, STM32F407 can carry out on-line identification to the torque of direct current generator, when the torque of motor receives the larger shake of external interference appearance, compensation time controller can utilize the relation of motor torque and electric current to carry out, decreases the impact of motor torque shake on slight mouse fast sprint.
10) if when mouse runs into power wheel stall or misreads labyrinth information in spurt process slightly; often there will be the phenomenon of hitting wall; now the electric current of motor will increase; when exceeding setting value; the interruptive command LPES of LM629 will send interrupt request to STM32F407; now STM32F407 can control four LM629 immediately and quits work; discharge motor X, motor Y, motor Z and motor R at once; not only reduce and efficiently solve stall problem, and decrease the destruction to system hardware.
12) when slight pindone becomes whole spurt process to arrive (F, F), (F, 10), (10, F), (10, 10), slight mouse can be put exploration and is masked as 1, slight mouse return is explored and is got back to starting point (0, 0), the PWM ripple of control four LM629 exports and makes slightly to stop at starting point central point by STM32F407, then the PWM ripple readjusting LM629 exports, make the motor of both sides: motor X and motor Y moves with contrary direction, and under gyrostatic control, turnback is revolved in original place, then stop 1 second, secondary transfers labyrinth information, then optimum spurt path is solved according to improvement ant group algorithm (Improvedantcolonyalgorithm), then put spurt and be masked as 1, system enters the secondary fast sprint stage.Then according to spurt----explore---spurt, completes spurt repeatedly, to reach the object of fast sprint.
Those skilled in the art should know; protection scheme of the present invention is not limited only to the above embodiments; various permutation and combination and conversion can also be carried out on the basis of above-described embodiment; such as compensation sensor L1 is set on mainboard; in the whole motion process of slight mouse; compensation sensor L1 can the moment to external world jamming light source gather; then STM32F407 is transferred to; the data auto-compensation external interference that STM32F407 transmits according to compensation sensor L1, decreases the interference of external interference light source to system.Such as battery is lithium ion battery.In a word under the prerequisite without prejudice to spirit of the present invention, the various conversion that the present invention carries out all are dropped in protection scope of the present invention.
Claims (8)
1. the slight mouse sprint controller of double-core middling speed four-wheel, comprise mainboard, it is characterized in that: also comprise battery, first sensor (S1), the second sensor (S2), the 3rd sensor (S5), four-sensor (S6), the first motor (X), the second motor (Y), the 3rd motor (R), the 4th motor (Z), the 5th motor (M), three-axis gyroscope (G1), three axis accelerometer (A1), vacuum plant, STM32F407 controller and 5 LM629 chips, they are installed on mainboard;
Described STM32F407 processor is electrically connected LM629 chip, described battery, first sensor (S1), the second sensor (S2), the 3rd sensor (S5), four-sensor (S6), three-axis gyroscope (G1) are all connected with STM32F407 controller signals with three axis accelerometer (A1), and 5 LM629 chips are connected with the first motor (X), the second motor (Y), the 3rd motor (R), the 4th motor (Z) and the 5th motor (M) signal respectively;
First sensor (S1), second sensor (S2), 3rd sensor (S5) and four-sensor (S6) are all positioned at mainboard upper surface front end, wherein two signal transmit directions are identical with wheel direct of travel, certain angle is had between two other signal transmit direction and wheel direct of travel, the elongated surfaces having the search coverage of two of certain angle sensors and mainboard to be provided with the side of wheel between signal transmit direction with wheel direct of travel intersects and search coverage can get around the transmit direction sensor position identical with wheel direct of travel, first motor (X), the second motor (Y), the 3rd motor (R) and the 4th motor (Z) are arranged on both sides in the middle part of mainboard with the four-wheel one_to_one corresponding, wherein two motors that are arranged in slight mouse both sides respectively, two other motor is arranged on both sides, mainboard rear end and makes slight mouse form the composite structure driving and add rear-guard, described 5th motor (M) is connected with vacuum plant.
2. the slight mouse sprint controller of double-core middling speed four-wheel according to claim 1, is characterized in that: the angle between the sensor signal transmit direction of described first sensor (S1) and the sensor signal transmit direction of the second sensor (S2) be more than or equal to 75 ° and be less than or equal to 90 °, the 3rd sensor (S5), four-sensor (S6) sensor signal transmit direction between angle be more than or equal to 75 ° and be less than or equal to 90 °.
3. the slight mouse sprint controller of double-core middling speed four-wheel according to claim 1, it is characterized in that: the first motor (X), the second motor (Y), the 3rd motor (R) and the 4th motor (Z) are permanent magnet DC motor, 5th motor (M) is direct current generator, and two motors be arranged in the middle part of mainboard in the first motor (X), the second motor (Y), the 3rd motor (R) and the 4th motor (Z) are larger than the power of motor of two other motor.
4. the slight mouse sprint controller of double-core middling speed four-wheel according to claim 1, is characterized in that: the first motor (X), the second motor (Y), the 3rd motor (R), the 4th motor (Z) and the 5th motor (M) be equipped with photoelectric encoder.
5. the slight mouse sprint controller of double-core middling speed four-wheel according to claim 1, it is characterized in that: described mainboard is also provided with the voltage sensor (V1), the first current sensor (C1), the second current sensor (C2), the 3rd current sensor (C3) and the 4th current sensor (C4) that are connected with STM32F407 controller signals, the first current sensor (C1), the second current sensor (C2), the 3rd current sensor (C3) and the 4th current sensor (C4) respectively with the motor one_to_one corresponding of four wheels controlling slight mouse.
6. the slight mouse sprint controller of double-core middling speed four-wheel according to claim 1, is characterized in that: first sensor (S1), the second sensor (S2), the 3rd sensor (S5) and four-sensor (S6) include infrared emission sensor OPE5594A and infrared remote receiver TSL262.
7. a control method for the slight mouse sprint controller of double-core middling speed four-wheel, is characterized in that comprising the following steps:
1) spurt prepares: slight mouse is placed on labyrinth starting point, turning on the power switch STM32F407 controller instantaneously can to detection battery supply, if low voltage voltage inductor (V1) by work and point out alerting signal point out charging, if voltage is normal, slight mouse is waited for the spurt order that controller sends and recalls the optimum labyrinth after exploring;
2) spurt discriminating direction: after receiving spurt order, first sensor (S1) and four-sensor (S6) can judge the environment in front, define and do not have barricade to enter range of movement, interrupt request will be sent to STM32F407 controller as there is barricade, STM32F407 controller can do very first time response to interruption, then control first motor (X) is forbidden, second motor (Y), 4 LM629 chip operations of the 3rd motor (R) and the 4th motor (Z), block the first motor (X), second motor (Y), the PWM drive singal of the 3rd motor (R) and the 4th motor (Z), it is made to be still in original place, then secondary judges that front information is determined in labyrinth, prevent information from judging by accident, if do not have barricade to enter the range of movement in front, slight mouse will open reset circuit, transfer normal labyrinth information, prepare to make a spurt normally,
3) spurt controls: when receiving the moment of slight mouse spurt, open unlatching the 5th motor (M), three-axis gyroscope (G1), three axis accelerometer (A1) and vacuum suction apparatus, vacuum suction apparatus make slight mouse over the ground mask have certain absorption affinity, three-axis gyroscope (G1), three axis accelerometer (A1) carries out to slight mouse direction of travel the generation departing from center phenomenon when auxiliary corrective avoids the spurt of slight mouse, first sensor (S1), second sensor (S2), 3rd sensor (S5) and four-sensor (S6) judge environment around and give STM32F407 controller by environmental parameter, STM32F407 requires these environmental parameters to be converted into the distance that slight mouse will run according to four axles walking servo control unit speed and acceleration, speed and acceleration command value and with LM629 chip communication, by LM629 chip according to these parameters again in conjunction with the photoelectric encoder of motor, first current sensor (C1), second inductor (C2), the feedback of the 3rd inductor (C3) and the 4th inductor (C4) generates driving first motor (X), second motor (Y), the PWM ripple of the 3rd motor (R) and the 4th motor (Z), STM32F407 controller requires control LM629 chip according to external environment condition and then controls the first motor (X), second motor (Y), two in 3rd motor (R) and the 4th motor (Z) or all work, PWM ripple amplifies rear drive two motors through drive axle or four motors make slight mouse move, complete whole accelerator until reach spurt setting speed, STM32F407 controller detects three-axis gyroscope (G1) in real time, three axis accelerometer (A1) and the first motor (X), second motor (Y), 3rd motor (R), 4th motor (Z), adjust according to the absorption affinity of slight speed to vacuum suction apparatus,
4) to turn to and straight movement control: first sensor (S1), the second sensor (S2), the 3rd sensor (S5) and four-sensor (S6) judge that environmental parameter is also given STM32F407 controller by environment around, if have labyrinth retaining wall to enter the range of movement in front in slight mouse forward movement, then judge whether left and right has barricade, if at least side is without barricade, if all there is barricade both sides of turning, turns around; Have in some lattice rectilinear coordinates in slight mouse forward movement display front and there is no barricade, judge that the range of movement in front does not stop that then mouse is by its present coordinate of storage slightly, processor passes to STM32F407 the location parameter of some lattice that travel forward, then four LM629 chip controls first motors (X), the second motor (Y), the 3rd motor (R) and the 4th motors (Z) make slight mouse thrust forward, and gyroscope G1, accelerometer A1 can record the distance of movement and flow to STM32F407 controller in the moment;
5) position judgment: when slight mouse controls the some lattice of lower motion apart from when arriving new address, microprocessor will upgrade its coordinate and is and judges that its coordinate is terminal, its coordinate is upgraded if not by continuation, if words notification controller to have made a spurt target, then arranging makes a return voyage explores mark, and slight mouse prepares return and explores.
8. the control method of the slight mouse sprint controller of a kind of double-core middling speed four-wheel according to claim 7, is characterized in that;
Return heuristic process is as follows: when slight mouse enters labyrinth return exploration, first sensor (S1), second sensor (S2), 3rd sensor (S5) and four-sensor (S6) are by work, and give STM32F407 controller the photosignal reflected, controller gives LM629 chip after judging, communication is carried out with STM32F407 controller by after the computing of LM629 chip, then send control signal to the first motor (X) by STM32F407 controller, second motor (Y), 3rd motor (R) and the 4th motor (Z) are determined, if enter the region searched for will advance fast, STM32F407 can strengthen the dutycycle controlling motor, with quickly through known region, reduce secondary and explore the time, if unknown return area then adopts normal speed to search for, in motion process, the controller moment detects slight mouse running status and in real time adjustment motor M carries out friction force adjustment and the moment upgrades its coordinate and judges that its coordinate is starting point,
Turn to and comprise error correction step with straight movement control step, error calibration method is as follows: mouse first sensor (S1), the second sensor (S2), the 3rd sensor (S5) and the labyrinth retaining wall of four-sensor (S6) moment to surrounding detect slightly, if signal there occurs the transition of bigger numerical, STM32F407 according to slight mouse current operating conditions fine compensation, can thoroughly eliminate slight mouse error accumulative in complex maze;
The method adopted when turning to: the air line distance travelling one section before proceeding to, carries out two sections according to certain radian when proceeding to and turns to, produce rear traveling one section of air line distance, during turning, first STM32F407 is converted into different speed parameters and acceleration parameter then according to state of ground enable two or four LM629 proceeding to the difference of front operating range according to spurt condition, and command value is transferred to the LM629 of control, LM629 can according to these parameters again in conjunction with photoelectric encoder, first current sensor (C1), second current sensor (C2), the feedback of the 3rd current sensor (C3) and the 4th current sensor (C4) generates the PWM waveform and direction that drive and take turns all around, control the first motor (X), second motor (Y), 3rd motor (R) and the 4th motor (Z) realize turning to.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201510521113.0A CN105137984A (en) | 2015-08-24 | 2015-08-24 | Double-core intermediate speed four-wheel mini mouse spurting controller |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201510521113.0A CN105137984A (en) | 2015-08-24 | 2015-08-24 | Double-core intermediate speed four-wheel mini mouse spurting controller |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN105137984A true CN105137984A (en) | 2015-12-09 |
Family
ID=54723359
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201510521113.0A Pending CN105137984A (en) | 2015-08-24 | 2015-08-24 | Double-core intermediate speed four-wheel mini mouse spurting controller |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN105137984A (en) |
Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2001199356A (en) * | 2000-01-17 | 2001-07-24 | Fuji Electric Co Ltd | Omni-directional moving vehicle and method for controlling it |
| CN103472835A (en) * | 2013-09-16 | 2013-12-25 | 苏州工业园区职业技术学院 | Fast sprint controller of four-wheel micro-mouse based on dual processors |
| CN103472838A (en) * | 2013-09-16 | 2013-12-25 | 苏州工业园区职业技术学院 | Fast sprint controller of four-wheel micro-mouse based on double processors |
| CN103605363A (en) * | 2013-09-16 | 2014-02-26 | 苏州工业园区职业技术学院 | Four-wheeled microcomputer mouse sprint controller based on ARM9 |
| CN203535477U (en) * | 2013-09-16 | 2014-04-09 | 苏州工业园区职业技术学院 | Four-wheel micro-mouse sprint controller based on ARM9 |
| CN203643838U (en) * | 2013-09-16 | 2014-06-11 | 苏州工业园区职业技术学院 | Dual-core four-wheeled micro-computer mouse and fast sprinting controller thereof |
-
2015
- 2015-08-24 CN CN201510521113.0A patent/CN105137984A/en active Pending
Patent Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2001199356A (en) * | 2000-01-17 | 2001-07-24 | Fuji Electric Co Ltd | Omni-directional moving vehicle and method for controlling it |
| CN103472835A (en) * | 2013-09-16 | 2013-12-25 | 苏州工业园区职业技术学院 | Fast sprint controller of four-wheel micro-mouse based on dual processors |
| CN103472838A (en) * | 2013-09-16 | 2013-12-25 | 苏州工业园区职业技术学院 | Fast sprint controller of four-wheel micro-mouse based on double processors |
| CN103605363A (en) * | 2013-09-16 | 2014-02-26 | 苏州工业园区职业技术学院 | Four-wheeled microcomputer mouse sprint controller based on ARM9 |
| CN203535477U (en) * | 2013-09-16 | 2014-04-09 | 苏州工业园区职业技术学院 | Four-wheel micro-mouse sprint controller based on ARM9 |
| CN203643838U (en) * | 2013-09-16 | 2014-06-11 | 苏州工业园区职业技术学院 | Dual-core four-wheeled micro-computer mouse and fast sprinting controller thereof |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN105334853A (en) | Double-core high-speed four-wheel miniature micro-mouse sprint controller | |
| CN105116897A (en) | Double-core high-speed four-wheeled picomouse full digital navigation servo controller | |
| CN203535477U (en) | Four-wheel micro-mouse sprint controller based on ARM9 | |
| CN105137983A (en) | Double-core high speed two-wheel mini mouse spurting controller and control method | |
| CN103529846B (en) | Based on double-core four-wheel high speed micro computer mouse continuous rotation sprint servo-drive system | |
| CN105137988A (en) | Single-core low-speed two-wheel mini mouse full digital navigation servo controller and control method | |
| CN103472835A (en) | Fast sprint controller of four-wheel micro-mouse based on dual processors | |
| CN105137979A (en) | Double-core intermediate speed six-wheel mini mouse spurting controller and control method | |
| CN105116898A (en) | Single-core low-speed two-wheeled picomouse sprint controller | |
| CN105005308A (en) | Six-wheel fire-fighting robot servo controller based on STM32F407 | |
| CN105204502A (en) | Dual-core medium-speed six-wheel little mouse exploration controller and control method thereof | |
| CN105116891A (en) | Double-core middle-speed two-wheeled picomouse sprint controller and control method thereof | |
| CN105137978A (en) | Double-core high-speed four-wheel mini mouse controller | |
| CN105137991A (en) | Single-core low-speed two-wheel mini mouse exploration controller | |
| CN105116896A (en) | Single-core low-speed six-wheeled picomouse exploration controller | |
| CN105302133A (en) | Single-core low-speed six-wheel miniature micro-mouse full-digital navigation servo system controller | |
| CN105159323A (en) | Six-wheel single-core fully automated type low-speed fire-extinguishing robot servo controller | |
| CN105137985A (en) | Double-core intermediate speed four-wheel mini mouse exploration device | |
| CN103472838A (en) | Fast sprint controller of four-wheel micro-mouse based on double processors | |
| CN105137982A (en) | Single-core low-speed four-wheel mini mouse sprint controller and control method for the same | |
| CN105137981A (en) | Single-core low-speed four-wheel mini mouse exploration controller and control method | |
| CN103472831B (en) | Based on double-core four-wheel micro computer Mus supper-fast exploration controller | |
| CN203643838U (en) | Dual-core four-wheeled micro-computer mouse and fast sprinting controller thereof | |
| CN105159324A (en) | Six-wheel and dual-core type medium-speed fire-extinguishing robot servo controller | |
| CN105137984A (en) | Double-core intermediate speed four-wheel mini mouse spurting controller |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20151209 |
|
| WD01 | Invention patent application deemed withdrawn after publication |