Embodiment
to the technical scheme in the utility model embodiment be clearly and completely described below, obviously, described embodiment is only a part of embodiment of the present utility model, instead of whole embodiment.Based on the embodiment in the utility model, those of ordinary skill in the art are not making all other embodiment that obtain under creative work prerequisite, all belong to the scope of the utility model protection.
refer to Fig. 1, Fig. 2 and Fig. 3, the utility model embodiment provides following technical scheme.
in one embodiment, the very fast company of a kind of two-wheeled micro computer mouse double-core controller turns spurt servo-drive system, comprising: cell apparatus, key device, sensor device, control module, first, second electric-motor drive unit, gyroscope rotary module, first, second motor; Between described cell apparatus, key device, sensor device, control module, first, second motor of first, second electric-motor drive unit, be electrically connected; Described gyroscope rotary module and control module are electrically connected; In described key device, be provided with automatic search module and gathering information module, between described automatic search module and gathering information module and key device and servo control unit, interconnect, according to the obtaining information of the automatic search module in described key device and gathering information module; In described sensor device, be provided with infrared transmitter and infrared remote receiver; In described control module, be provided with motion controller ARM9, be responsible for the very fast driving governor FPGA of deal with data communication, the selection module of making a spurt and spurt motion module, between described motion controller ARM9 and very fast driving governor FPGA, be electrically connected.
be different from prior art, in one embodiment, described spurt selects module further to include automatic spurt module, make a spurt module and setting speed spurt module fast, described automatic spurt module, module and the setting speed spurt module of making a spurt is connected respectively and between described key device fast, realizes choosing of spurt mode according to key device.
described spurt selects module further to include automatic spurt module, make a spurt module and setting speed spurt module fast, and described automatic spurt module, make a spurt module and setting speed spurt module is electrically connected with described key device respectively fast.
in described spurt motion module, be further provided with photoelectric encoder and current sensor, between described photoelectric encoder and current sensor and described very fast driving governor FPGA, be connected.
in described spurt motion module, also further include: coordinate memory module, instruction conversion module, PWM control module and the drive axle that left control motor and the right motor of control are controlled, be electrically connected between described coordinate memory module, instruction conversion module, PWM control module and drive axle.
in described straight dash module, be further provided with barricade identification module and straight dash unit, described barricade identification module is connected with described coordinate memory module, motion controller ARM9, instruction conversion module, very fast driving governor FPGA and drive axle with straight dash unit.
described turning in spurt module is further provided with and turns to spurt unit, data transmission module, data conversion module, speed generation module and error compensation module; Described turn to spurt unit, data transmission module, data conversion module, speed generation module and error compensation module to be generated by described motion controller ARM9 and very fast driving governor FPGA and and drive axle between be electrically connected.
in described curve spurt module, further include coordinate renew module, error compensation module, speed adjusting module, between described coordinate renew module, speed adjusting module and gyroscope rotary module, described motion controller ARM9, instruction conversion module, very fast driving governor FPGA, PWM control module and drive axle, be electrically connected successively.
in described curve spurt module, in the time that described signal arrives set objective, be divided into five kinds and connect and transmission mode, be respectively:
(1) between coordinate memory module and described motion controller ARM9, instruction conversion module, very fast driving governor FPGA, PWM control module and drive axle, be connected, thus signal flow to described motion controller ARM9, instruction conversion module, very fast driving governor FPGA by coordinate memory module and be combined with photoelectric encoder and current sensor after flow to PWM control module and drive axle;
(2) between parameter conversion module and very fast driving governor FPGA, PWM control module and drive axle, be connected, thus described signal flow to very fast driving governor FPGA by parameter conversion module and be combined with photoelectric encoder and current sensor after flow to PWM control module and drive axle;
(3) between coordinate renew module and error compensation module, speed conversion module and drive axle, be connected, thereby described signal flows to error compensation module and speed conversion module and drive axle by coordinate renew module;
(4) between speed adjusting module, parameter conversion module, very fast driving governor FPGA, PWM control module and drive axle, connect, thus described signal flow to very fast driving governor FPGA by speed adjusting module, parameter conversion module and be combined with photoelectric encoder and current sensor after flow to PWM control module and drive axle;
(5) between gyroscope rotary module and parameter conversion module, very fast driving governor FPGA, PWM control module and drive axle, be connected, thus described signal flow to parameter conversion module and very fast driving governor FPGA by gyroscope rotary module and be combined with photoelectric encoder and current sensor after flow to PWM control module and drive axle.
in order to further describe the motion control in play of micro computer mouse, please refer to Fig. 4, Fig. 5, Fig. 6, Fig. 7, Fig. 8, Fig. 9, Figure 10, Figure 11, Figure 12, Figure 13, Figure 14 and Figure 15, its concrete function is achieved as follows:
in micro computer mouse opening power moment, system will complete spurt according to the mode of Fig. 7.First system will complete initialization, then wait for key information, before not receiving key information order, it generally can wait for the spurt order that controller sends at starting point coordinate (0,0), according to key information, the utility model provides multiple spurt method: (1) if press be START(start) key, illustrative system will be abandoned the advanced line search of former labyrinth information, has then searched for the spurt labyrinth information that rear generation is optimized, and micro computer mouse enters automatically the repeatedly sprint stage; (2) if what press is that RESET(resets)+STRAT(starts) key, the optimum labyrinth after illustrative system will recall and explore, then starts fast to terminal (7,7), (7,8), (8,7), (8,8) spurt along starting point; (3) if press be RESET(reset)+STRAT(start)+SPEED(speed) key, the optimum labyrinth after illustrative system will recall and explore, then along starting point with set dash speed start fast to terminal (7,7), (7,8), (8,7), (8,8) spurt.
micro computer mouse is received task at starting point coordinate (0,0), and in order to prevent from misplacing spurt direction, sensor S1, the S6 in its front and can judging the environment in front, defines and do not have barricade to enter range of movement.
(1) as existed barricade to incite somebody to action: send interrupt request to ARM9 (S3C2440A), ARM9 (S3C2440A) can be to interrupting doing very first time response, if the interrupt response of ARM9 (S3C2440A) does not have enough time to process, X motor and the Y motor of micro computer mouse will continue self-locking, then secondary judges that labyrinth determines front information, prevents information erroneous judgement; (2) if do not have barricade to enter the range of movement in front, micro computer mouse will be made a spurt normally.
start spurt moment at micro computer, sensor S1, S2, S3, S4, S5, six infrared lights that independently infrared transmitting tube OPE5594A sends of S6(are converted into the information in labyrinth around after receiver TSL262 accepts) judge environment around and give ARM9(S3C2440A).By ARM9(S3C2440A) according to the instruction set-point of the S curvilinear path of spurt labyrinth Information generation Fig. 6, the area that this graphics package contains is exactly the distance S1 that micro computer mouse two the first motors 1, the second motors 2 will move.Then with FPGA communication, then FPGA generates in conjunction with the feedback of photoelectric coded disk and current sensor the PWM ripple that drives diaxon direct current generator according to speed, acceleration parameter command value.PWM ripple, through two direct current generators of drive axle rear drive, completes whole accelerator until reach spurt setting speed, and deal with data communication to ARM9(S3C2440A), by ARM9(S3C2440A) continue to process follow-up running status.
(1) if do not have barricade to enter the range of movement in front micro computer mouse along the Y-axis Z lattice coordinate that travels forward, system enters spurt subroutine 1, micro computer mouse will be stored its coordinate (X, Y), for walking need to fast, give up traditional single speed spurt pattern, accelerate and slow down according to the speed of Fig. 6 and time curve, travel forward in process at it, ARM9 (S3C2440A) is converted into according to time requirement acceleration and the speed value that micro computer mouse need to be made a spurt the distance of Z lattice forward, then with FPGA communication.FPGA is converted into actual speed and acceleration in conjunction with the feedback of photoelectric encoder and current sensor acceleration and speed value, generated the PWM ripple signal that drives diaxon direct current generator by FPGA, arrive preset distance through drive axle rear drive micro computer mouse, micro computer mouse is every through a grid in spurt process, to upgrade its coordinate is (X, Y+1), under the prerequisite of Y+1<15, judge that its coordinate is (7, 7), (7, 8), (8, 7), (8, 8) one of them, if not continuing to upgrade its coordinate, if the words notification controller target of having made a spurt, then putting the exploration of making a return voyage and being masked as 1, spurt is masked as 0, the secondary return that micro computer mouse is prepared after spurt is explored, remove to search more excellent maze path.
if have multiple coordinates not have barricade to enter the range of movement in front micro computer mouse in Y-axis counter motion process, system enters spurt subroutine 1, and micro computer mouse will be stored now coordinate (X, Y), in order to walk and to need fast, give up traditional single speed spurt pattern.Accelerate and slow down according to the speed of Fig. 6 and time curve, travel forward in process at it, ARM9 (S3C2440A) is converted into according to time requirement acceleration and the speed value that micro computer mouse need to be made a spurt the distance of Z lattice forward, then with FPGA communication, FPGA is converted into actual speed and acceleration in conjunction with the feedback of photoelectric encoder and current sensor acceleration and speed value, generated the PWM ripple signal that drives diaxon direct current generator by FPGA, arrive preset distance through drive axle rear drive micro computer mouse, micro computer mouse is every through a grid in spurt process, , to upgrade its coordinate is (X, Y-1), determining under the prerequisite of Y-1>0, judge that its coordinate is (7, 7), (7, 8), (8, 7), (8, 8) one of them, if not continuing to upgrade its coordinate, if the words notification controller target of having made a spurt, then putting the exploration of making a return voyage and being masked as 1, spurt is masked as 0, the secondary return that micro computer mouse is prepared after spurt is explored, remove to search more excellent maze path.
(2) if having barricade to enter the range of movement in front micro computer mouse in motion process before Y-axis, and when now in the information of labyrinth, left has barricade, system enters spurt subroutine 2, micro computer mouse will be stored now coordinate (X, Y), then enter the curvilinear motion track shown in Fig. 8, in the time that right spurt is turned, micro computer mouse is transferred to ARM9 (S3C2440A) by first going to straight line to walk very short distance B ashTurn_R90_Leading, ARM9 (S3C2440A) is according to the time requirement of spurt, this distance is converted into corresponding position, then speed and assisted instruction are transferred to FPGA, FPGA is again in conjunction with the photoelectric encoder A of motor feedback, B, Z and current of electric I signal generate the PWM ripple of controlling the first motor 1 and the second motor 2, then drive two-wheeled motor rotation to precalculated position through drive axle, now R90_FrontWallRef starts working, prevent that external interference from starting to do error compensation, then micro computer mouse is transferred to DashTurn_R90_Arc1 ARM9 (S3C2440A), ARM9 (S3C2440A) is according to new spurt time requirement, this distance is converted into corresponding position, speed and assisted instruction and is then transferred to FPGA, FPGA generates and controls the first motor 1 and the PWM ripple of the second motor 2 and speed DashTurn_R90_VelX1 and the DashTurn_R90_VelY1 of motor in conjunction with photoelectric encoder A, B, Z and the current of electric I signal of motor feedback again, then drives two-wheeled motor rotation to precalculated position through drive axle, subsequently, micro computer mouse starts to regulate the speed micro computer mouse is transferred to ARM9 (S3C2440A) by the distance B ashTurn_R90_Arc2 of walking, ARM9 (S3C2440A) is according to new spurt time requirement, this distance is converted into corresponding position, then speed and assisted instruction are transferred to FPGA, FPGA generates and controls the first motor 1 and the PWM ripple of the second motor 2 and speed DashTurn_R90_VelX2 and the DashTurn_R90_VelY2 of motor in conjunction with the feedback of photoelectric encoder and current of electric again, then drive two-wheeled motor rotation to precalculated position through drive axle, and micro computer mouse under gyroscope control the right side turn 90 degrees, micro computer mouse starts to regulate the speed micro computer mouse is transferred to ARM9 (S3C2440A) by the distance B ashTurn_R90_Passing of walking, ARM9 (S3C2440A) is according to new spurt time requirement, this distance is converted into corresponding position, then speed and assisted instruction are transferred to FPGA, FPGA generates and controls the first motor 1 and second PWM of motor 2 and the speed DashTurn_R90_VelX3 of motor and DashTurn_R90_VelY3 in conjunction with the feedback of photoelectric encoder and current of electric again, then drive two-wheeled motor rotation to precalculated position through drive axle, through four sections of different speed, the geometric locus that completes whole right-hand bend with the closed-loop control of electric current moves.Now will upgrade its coordinate for (X+1, Y), under the prerequisite of X+1<15, judge that its coordinate is (7,7), (7,8), (8,7), (8,8) one of them, if not continuing to upgrade its coordinate, if the words notification controller target of having made a spurt, then putting the exploration of making a return voyage and being masked as 1, spurt is masked as 0, and the secondary return that micro computer mouse is prepared after spurt is explored, and removes to search more excellent maze path.
(3) if having barricade to enter the range of movement in front micro computer mouse in motion process before Y-axis, and now right-hand while having barricade in the information of labyrinth, system enters spurt subroutine 3, micro computer mouse will be stored now coordinate (X, Y), then enter the curvilinear motion track shown in Fig. 9, in the time that right spurt is turned, micro computer mouse is transferred to ARM9 (S3C2440A) by first going to straight line to walk very short distance B ashTurn_L90_Leading, ARM9 (S3C2440A) is according to the time requirement of spurt, this distance is converted into corresponding position, then speed and assisted instruction are transferred to FPGA.FPGA generates in conjunction with photoelectric encoder A, B, Z and the current of electric I signal of motor feedback the PWM ripple of controlling the first motor 1 and the second motor 2 again, then drive two-wheeled motor rotation to precalculated position through drive axle, now L90_FrontWallRef starts working, and prevents that external interference from starting to do error compensation, then micro computer mouse is transferred to DashTurn_L90_Arc1 ARM9 (S3C2440A), ARM9 (S3C2440A) is according to new spurt time requirement, then position, speed and assisted instruction that this distance is converted into response are transferred to FPGA, FPGA generates and controls the first motor 1 and the PWM ripple of the second motor 2 and speed DashTurn_L90_VelX1 and the DashTurn_L90_VelY1 of motor in conjunction with photoelectric encoder A, B, Z and the current of electric I signal of motor feedback again, then drives two-wheeled motor rotation to precalculated position through drive axle, subsequently, micro computer mouse starts to regulate the speed micro computer mouse is transferred to ARM9 (S3C2440A) by the distance B ashTurn_L90_Arc2 of walking, ARM9 (S3C2440A) is according to new spurt time requirement, this distance is converted into corresponding position, then speed and assisted instruction are transferred to FPGA, FPGA generates and controls the first motor 1 and the PWM ripple of the second motor 2 and speed DashTurn_L90_VelX2 and the DashTurn_L90_VelY2 of motor in conjunction with the feedback of photoelectric encoder and current of electric again, then drive two-wheeled motor rotation to precalculated position through drive axle, micro computer mouse starts to regulate the speed micro computer mouse is transferred to ARM9 (S3C2440A) by the distance B ashTurn_L90_Passing of walking, ARM9 (S3C2440A) is according to new spurt time requirement, this distance is converted into corresponding position, then speed and assisted instruction are transferred to FPGA, FPGA generates and controls the first motor 1 and the PWM ripple of the second motor 2 and speed DashTurn_L90_VelX3 and the DashTurn_L90_VelY3 of motor in conjunction with the feedback of photoelectric encoder and current of electric again, then drive two-wheeled motor rotation to precalculated position through drive axle, and micro computer mouse under gyroscope control the right side turn 90 degrees, through four sections of different speed, the geometric locus that completes whole right-hand bend with the closed-loop control of electric current moves.Now will upgrade its coordinate for (X-1, Y), under the prerequisite of X-1>0, judge that its coordinate is (7,7), (7,8), (8,7), (8,8) one of them, if not continuing to upgrade its coordinate, if the words notification controller target of having made a spurt, then putting the exploration of making a return voyage and being masked as 1, spurt is masked as 0, and the secondary return that micro computer mouse is prepared after spurt is explored, and removes to search more excellent maze path.
(4) micro computer mouse in motion process before X-axis, Y-axis, if occur, the staircase-type labyrinth retaining wall shown in Figure 10 enters the range of movement in front, system enters spurt subroutine 4.Micro computer mouse will be stored now coordinate (X, Y), then enter the curvilinear motion track shown in Figure 11, Figure 12, in the time that once right spurt is turned, ARM9 (S3C2440A) is first converted into speed parameter and acceleration parameter command value the very short distance L eading1 of walking straight line according to different spurt condition time requirement, then with FPGA communication.FPGA generates the PWM ripple of controlling left and right wheels in conjunction with the feedback of the photoelectric encoder on the first motor 1 and the second motor 2 and current sensor, then by drive axle control left and right wheels with identical acceleration and speed straight ahead;
in the time arriving set objective, be (X, Y+1) labyrinth coordinate renew now, sensor reference value R90_FrontWallRef starts working, and prevents that external interference from starting to do error compensation.After finishing, error compensation starts to adjust direct current the first motor 1 and direct current the second motor 2 speed are DashTurn_R90_VelX1 and DashTurn_R90_VelY1, this Time Controller can be converted into speed parameter and acceleration parameter command value according to different spurt condition time requirement curvilinear motion track R_Arc1, then with FPGA communication, FPGA generates in conjunction with the feedback of the photoelectric encoder on the first motor 1 and the second motor 2 and current sensor the PWM ripple of controlling left and right wheels, then advances with constant ratio by the speed of drive axle control left and right wheels.
when arriving after set objective, adjusting immediately micro computer mouse speed is DashTurn_R90_VelX2 and DashTurn_R90_VelY2, this Time Controller can be converted into speed parameter and acceleration parameter command value according to different spurt condition time requirement curvilinear motion track R_Arc2, then with FPGA communication, FPGA generates in conjunction with the feedback of the photoelectric encoder on the first motor 1 and the second motor 2 and current sensor the PWM ripple of controlling left and right wheels, then advances with constant ratio by the speed of drive axle control left and right wheels.
when arriving after set objective, micro computer mouse under gyroscope control the right side turn 90 degrees, controller, the very short distance P assing1+Leading2 of straight line moving, is converted into speed parameter and acceleration parameter command value according to different spurt condition time requirement, then with FPGA communication.FPGA generates in conjunction with the feedback of the photoelectric encoder on the first motor 1 and the second motor 2 and current sensor the PWM ripple of controlling left and right wheels, then advances with identical acceleration and speed by drive axle control left and right wheels.In the time that the value generation of sensor S2 has high level to arrive low level transition, upgrading micro computer mouse coordinate is (X+1, Y+1), and micro computer mouse continues to advance with current speed and acceleration.
in the time arriving set objective, sensor reference value L90_FrontWallRef starts working, and prevents that external interference from starting to do error compensation.After finishing, error compensation starts to adjust direct current the first motor 1 and direct current the second motor 2 speed are DashTurn_L90_VelX1 and DashTurn_L90_VelY1.This Time Controller can be converted into speed parameter and acceleration parameter command value according to different spurt condition time requirement curvilinear motion track L_Arc1, then with FPGA communication, FPGA generates in conjunction with the feedback of the photoelectric encoder on the first motor 1 and the second motor 2 and current sensor the PWM ripple of controlling left and right wheels, then advances with constant ratio by drive axle control left and right wheels speed;
when arriving after set objective, adjusting immediately micro computer mouse speed is DashTurn_L90_VelX2 and DashTurn_L90_VelY2, this Time Controller can be converted into speed parameter and acceleration parameter command value according to different spurt condition time requirement curvilinear motion track L_Arc2, then with FPGA communication, FPGA generates in conjunction with the feedback of the photoelectric encoder on the first motor 1 and the second motor 2 and current sensor the PWM ripple of controlling left and right wheels, then advances with constant ratio by drive axle control left and right wheels speed;
when arriving after set objective, micro computer mouse under gyroscope control a left side turn 90 degrees, controller is converted into speed parameter and acceleration parameter command value distance P assing2+Leading3 very short straight line moving according to different spurt condition time requirement, then with FPGA communication, FPGA generates in conjunction with the feedback of the photoelectric encoder on the first motor 1 and the second motor 2 and current sensor the PWM ripple of controlling left and right wheels, then advance with identical acceleration and speed by drive axle control left and right wheels, in the time that the value generation of sensor S5 has high level to arrive low level transition, micro computer pindone becomes the spurt of stair, upgrading micro computer mouse coordinate is (X+2, Y+1), the rest may be inferred, in the time that micro computer pindone becomes the spurt of Z lattice stair labyrinth, be (X+Z at the coordinate of Z lattice, Y+Z), the coordinate of going out Z lattice stair labyrinth is (X+Z+1, Y+Z), under the prerequisite of X+Z+1<15 and Y+Z<15, judge that its coordinate is (7, 7), (7, 8), (8, 7), (8, 8) one of them, if not continuing to upgrade its coordinate, if the words notification controller target of having made a spurt, then putting the exploration of making a return voyage and being masked as 1, spurt is masked as 0, the secondary return that micro computer mouse is prepared after spurt is explored, remove to search more excellent maze path.
(5) if having the U-shaped labyrinth retaining wall of similar Figure 13 to enter the range of movement in front micro computer mouse in motion process before X-axis, Y-axis, system enters spurt subroutine 5.Micro computer mouse will be stored now coordinate (X, Y), then enter Figure 14, curvilinear motion track shown in Figure 15, in the time that once right spurt is turned, ARM9 (S3C2440A) is first converted into speed parameter and acceleration parameter command value the very short distance L eading1 of walking straight line according to different spurt condition time requirement, then be transferred to FPGA, FPGA generates in conjunction with the feedback of the photoelectric encoder on the first motor 1 and the second motor 2 and current sensor the PWM ripple of controlling left and right wheels, then by drive axle control left and right wheels with identical acceleration and speed straight ahead.
in the time arriving set objective, be (X, Y+1) labyrinth coordinate renew now, sensor reference value R90_FrontWallRef starts working, and prevents that external interference from starting to do error compensation.After error compensation finishes, controller can be converted into speed parameter and acceleration parameter command value according to different spurt condition time requirement curvilinear motion track R_Arc1, then be transferred to FPGA, FPGA generates in conjunction with the feedback of the photoelectric encoder on the first motor 1 and the second motor 2 and current sensor the PWM ripple of controlling left and right wheels, then turns with constant ratio by the speed of drive axle control left and right wheels.
when arriving after set objective, adjust immediately the speed of micro computer mouse, controller can be converted into speed parameter and acceleration parameter command value according to different spurt condition time requirement curvilinear motion track R_Arc2, then be transferred to FPGA, FPGA generates in conjunction with the feedback of the photoelectric encoder on the first motor 1 and the second motor 2 and current sensor the PWM ripple of controlling left and right wheels, then turns with constant ratio by the speed of drive axle control left and right wheels.
when arriving after set objective, and micro computer mouse under gyroscope control the right side turn 90 degrees, controller is the very short distance P assing1+Leading2 of straight line moving, be converted into speed parameter and acceleration parameter command value according to different spurt condition time requirement, then be transferred to FPGA, FPGA generates in conjunction with the feedback of the photoelectric encoder on the first motor 1 and the second motor 2 and current sensor the PWM ripple of controlling left and right wheels, then advance with identical acceleration and speed by drive axle control left and right wheels, in the time that the value generation of sensor S5 has low level to arrive the transition of high level, upgrading micro computer mouse coordinate is (X+1, Y+1), micro computer mouse continues to advance with current speed and acceleration.
in the time arriving set objective, sensor reference value R90_FrontWallRef starts working, and prevents that external interference from starting to do error compensation.After error compensation finishes, micro computer mouse continues to turn right, controller can be converted into speed parameter and acceleration parameter command value according to different spurt condition time requirement curvilinear motion track R_Arc1, then be transferred to FPGA, FPGA generates in conjunction with the feedback of the photoelectric encoder on the first motor 1 and the second motor 2 and current sensor the PWM ripple of controlling left and right wheels, then turns with constant ratio by the speed of drive axle control left and right wheels.
when arriving after set objective, adjust immediately the speed of micro computer mouse, controller can be converted into speed parameter and acceleration parameter command value according to different spurt condition time requirement curvilinear motion track R_Arc2, then be transferred to FPGA, FPGA generates in conjunction with the feedback of the photoelectric encoder on the first motor 1 and the second motor 2 and current sensor the PWM ripple of controlling left and right wheels, then turns with constant ratio by the speed of drive axle control left and right wheels.
when arriving after set objective, micro computer mouse under gyroscope control the right side turn 90 degrees, controller is converted into speed parameter and acceleration parameter command value distance P assing2 very short straight line moving according to different spurt condition time requirement, then be transferred to FPGA, FPGA generates in conjunction with the feedback of the photoelectric encoder on the first motor 1 and the second motor 2 and current sensor the PWM ripple of controlling left and right wheels, then advances by drive axle control left and right wheels identical acceleration and speed.
arrive after set objective, micro computer pindone becomes the spurt in a U-shaped labyrinth, and upgrading micro computer mouse coordinate is (X+1,, and judge whether (7,7), (7 of its coordinate Y), 8), (8,7), (8,8) one of them, if not continuing to upgrade its coordinate, if the words notification controller target of having made a spurt, then putting makes a return voyage explores and is masked as 1, spurt is masked as 0, the secondary return that micro computer mouse is prepared after spurt is explored, and removes to search more excellent maze path;
when the spurt of micro computer mouse arrives (7,7), (7,8), (8,7), (8,8) after, the return that can prepare after spurt is explored to search more excellent path, and ARM9 (S3C2440A) can recall its labyrinth information of having stored, then calculate other optimal path that may exist, then return starts to enter one that wherein thinks optimum.
in the time that micro computer mouse enters labyrinth return exploration, the sensor S1 of its navigation, S2, S3, S4, S5, S6 is by work, and give ARM9 (S3C2440A) the photosignal reflecting, after ARM9 (S3C2440A) judgement, give FPGA, by carrying out communication with ARM9 (S3C2440A) after FPGA computing, then send first motor 1 and second motor 2 of control signal to navigation to determine by controller: will advance fast if enter the region of having searched for, if unknown return area adopts normal speed search, and the moment upgrade its coordinate (X, Y), and judge that its coordinate is (0, 0), if words put make a return voyage explore be masked as 0, micro computer mouse enters the sprint stage, juxtaposition spurt is masked as 1.
in order to realize micro computer mouse coordinate computing function accurately, the utility model has added the photoelectric encoder of 512 lines in High-speed DC the first motor 1 axle and Y-axis, moment calculates and with pillar, the different feature of sensor feedback information has been introduced to compensation according to labyrinth retaining wall the distance of micro computer mouse operation, makes the spurt coordinate calculating of micro computer mouse there will not be mistake.
in order to reduce the interference of light source to the spurt of micro computer mouse, the utility model has added photoelectric sensor S8, this sensor can the micro computer mouse sprint stage to around abnormal light source read, and automatically give controller and do real-Time Compensation, eliminated the interference of external light source to spurt.
in micro computer mouse operational process, ARM9 (S3C2440A) can carry out on-line identification to the torque of direct current the first motor 1 and the second motor 2, in the time that the torque of motor is subject to the larger shake of external interference appearance, compensation when controller can utilize the relation of direct current generator moment and electric current to carry out, has reduced motor torque and has shaken the impact on micro computer mouse sound lunge.
when completing whole spurt process, micro computer arrives (7, 7), (7, 8), (8, 7), (8, 8), micro computer mouse can be put to explore and is masked as 1, micro computer mouse return is explored and is got back to starting point (0, 0), ARM9(S3C2440A) make micro computer mouse at origin coordinates (0 control FPGA, 0) central point stops, then readjust the PWM ripple output of FPGA, make the first motor 1 and the second motor 2 with contrary direction motion, and under gyrostatic control, original place Rotate 180 degree, then stop 1 second, secondary is transferred labyrinth information, then calculate according to algorithm the optimum spurt path of optimizing after the information of labyrinth, then put spurt and be masked as 1, system enters the quick sprint stage of secondary.Then according to spurt,---exploration---spurt, completes spurt repeatedly, to reach the object of quick spurt.
the foregoing is only embodiment of the present utility model; not thereby limit the scope of the claims of the present utility model; every equivalent structure or conversion of equivalent flow process that utilizes the utility model instructions and accompanying drawing content to do; or be directly or indirectly used in other relevant technical field, be all in like manner included in scope of patent protection of the present utility model.