A kind of system of automatic cleaning garbage on water
Technical field
The present invention relates to a kind of automatic systems of cleaning garbage on water, a kind of device including automatic cleaning garbage on water and
A kind of method of automatic cleaning garbage on water is specifically collected rubbish using a kind of automatic floating and solar power generation
Rubbish belongs to field of environment protection.
Background technique
Wait until autumn, can float on man-made lake a large amount of fallen leaves inside park, and the time, which has been grown, can pollute water quality, therefore park
Canoe can be usually arranged to salvage the fallen leaves on lake surface;And sometimes, on lake surface even can adrift rubbish such as a lot of polybags, sternly
Ghost image rings the beauty of man-made lake, therefore personnel's periodic cleaning lake surface of arranging work becomes essential, still, due to staff
It is periodic cleaning rubbish, is not to implement cleaning rubbish, bad impression still can be brought to tourist, therefore, urgent need wants one kind can
To clear up the device of floating refuse on lake surface at any time.
Summary of the invention
In view of the above-mentioned deficiencies, the present invention provides a kind of systems of automatic cleaning garbage on water.
The present invention is achieved by the following technical solutions:
A kind of system of automatic cleaning garbage on water, the device including a kind of automatic cleaning garbage on water, is by ultrasonic wave
Sensor, solar panels, folds big bar, small front apron, folds small bar, big baffle, the folding of big baffle ultrasonic sensor mounting rack
Big bar, big baffle fold small bar, air bag, filter screen, hull, stepper motor, motor drive plate, drive rod, motor mounting plate, circle
Column roller bearing, ball, propeller, controller, battery and motor form, the air bag is fixedly mounted on the two of hull
Side, the battery are mounted on hull, and the controller is mounted on hull, and the solar panels are fixedly mounted on ship
On body, the battery and controller is located at solar panels in the following, the ultrasonic sensor mounting rack is fixedly mounted on ship
On body, the ultrasonic sensor is fixedly mounted on ultrasonic sensor mounting rack, and one end of the big bar of folding is logical
Axis to be crossed to be fitted on hull, the other end of the big bar of folding is installed together by axis with the one end for folding small bar,
The other end and small front apron of the small bar of folding are installed together by axis, and the small front apron is mounted on by axis and hull
Together, the stepper motor is mounted on the rear end of hull, the output shaft of the stepper motor and one end of motor drive plate
It is fixedly installed togather, the other end of the motor drive plate and one end of drive rod pass through axis connection, the drive rod
The other end be installed togather by bearing and motor mounting plate, the motor mounting plate by cylinder roller bearing with
Hull is installed together, and the cylinder roller bearing is fixedly mounted on the rear end of hull, and the ball engagement is mounted on ship
Between body and motor mounting plate, the motor mounting plate is fixedly installed togather with filter screen, and the motor is fixedly mounted
On motor mounting plate, the propeller is fixedly mounted on motor output shaft, and described big baffle one end is fixed by axis
It is mounted below hull, one end that the big baffle folds big bar is connect by axis with hull, and the big baffle folds
The big bar other end is linked together by one end that axis folds small bar with big baffle, and the big baffle folds the other end of small bar
Together with passing through axis connection with big baffle, the battery and solar panels are electrically connected, the ultrasonic sensor and control
Device processed is electrically connected, and the motor is electrically connected with the battery, and the stepper motor and controller are electrically connected.
The hull is by hull main body, filter hole, stepper motor mounting rack, spherical guide, motor mounting plate limit
What plate and motor mounting plate limit hole formed, the stepper motor mounting rack is fixedly mounted on hull rear end, the motor
Mounting plate limit plate is fixedly mounted on stepper motor mounting rack, and the spherical guide is located on motor mounting plate limit plate,
The motor mounting plate limit hole is located on motor mounting plate limit plate, and the hull lower end and rear end are evenly distributed with filtering
Hole folds the holding tank of big bar below the hull with big baffle.
The motor mounting plate is by motor mounting plate limited post, motor mounting plate limit base for post, drive rod limit
What column, the second spherical guide and electric machine spacing mounting plate formed, the motor mounting plate limited post is fixedly mounted on motor peace
Loading board limits the lower surface of base for post, and the drive rod limited post is fixedly mounted on the upper table of motor mounting plate limit base for post
Face, the motor mounting plate limit base for post are fixedly installed togather with electric machine spacing mounting plate, and second ball is led
Rail is located on electric machine spacing mounting plate.
It totally two pieces of the solar panels, is symmetrically mounted on hull.
When any one of two ultrasonic sensors in the right generation signal and two, left side ultrasonic sensor does not generate letter
Number, controller driving stepper motor rotates clockwise 30 degree, so that hull be driven to turn left, when two, the left side, supersonic sensing is had a high regard for
What generations signal and when two, the right ultrasonic sensor does not generate signal, controller drives stepper motor to turn counterclockwise
Dynamic 30 degree, so that hull be driven to turn right, when three, left side ultrasonic sensor generation signal, illustrate that hull levels off to parallel bank
Side, controller driving stepper motor rotates counterclockwise 45 degree, so that hull be driven to turn right rapidly, when being reduced to two, left side ultrasound
At least any one generates signal to wave sensor and two, the right ultrasonic sensor does not generate signal, and controller drives stepping
Motor rotates clockwise 15 degree, reduces turn amplitude, after all ultrasonic sensors can't detect signal, controller control
Stepper motor sets back, i.e., motor is parallel to hull, the straight trip of motor pushing hull;When three, the right, ultrasonic sensor is generated
Signal illustrates that hull levels off to parallel bank, and controller driving stepper motor rotates clockwise 45 degree, to drive hull rapid
Turn left, when being reduced to two ultrasonic sensors in the right, at least any one generates signal and two, left side ultrasonic sensor is equal
Signal is not generated, and controller driving stepper motor rotates counterclockwise 15 degree, reduces turn amplitude, when all ultrasonic sensors are equal
It is good to can't detect signal, controller control stepper motor sets back, i.e., motor is parallel to hull, the straight trip of motor pushing hull.
The controller uses singlechip chip, the part I/O electric connection of ultrasonic sensor and single-chip microcontroller.
A kind of system of automatic cleaning garbage on water, a kind of method including automatic cleaning garbage on water, this method use
One kind is by ultrasonic sensor, ultrasonic sensor mounting rack, solar panels, the big bar of folding, small front apron, the small bar of folding, big gear
Plate, big baffle fold big bar, big baffle folds small bar, air bag, filter screen, hull, stepper motor, motor drive plate, drive rod,
Motor mounting plate, cylinder roller bearing, ball, propeller, controller, battery and motor form automatic cleaning garbage on water
Device, the air bag are fixedly mounted on the two sides of hull, and the battery is mounted on hull, and the controller is mounted on
On hull, the solar panels are fixedly mounted on hull, and the battery and controller are located at solar panels in the following, described
Ultrasonic sensor mounting rack be fixedly mounted on hull, the ultrasonic sensor is fixedly mounted on ultrasonic sensor
On mounting rack, one end of the big bar of folding is fitted on hull by axis, and the other end of the big bar of folding is logical
It crosses axis and is installed together with the one end for folding small bar, the other end and small front apron of the small bar of folding are mounted on one by axis
It rises, the small front apron is installed together by axis and hull, and the stepper motor is mounted on the rear end of hull, the step
It is fixedly installed togather into one end of the output shaft and motor drive plate of motor, the other end of the motor drive plate and transmission
By axis connection, the other end of the drive rod is installed togather by axis and motor mounting plate, described for one end of bar
Motor mounting plate be installed together by cylinder roller bearing and hull, the cylinder roller bearing is fixedly mounted on hull
Rear end, the ball engagement is mounted between hull and motor mounting plate, and the motor mounting plate is fixed with filter screen
It is installed together, the motor is fixedly mounted on motor mounting plate, and the propeller is fixedly mounted on motor output shaft
On, described big baffle one end is fixedly mounted below hull by axis, and one end that the big baffle folds big bar passes through
Axis is connect with hull, and the big baffle folds the big bar other end and is connected to one by one end that axis and big baffle fold small bar
It rises, the big baffle folds together with the other end of small bar with big baffle passes through axis connection, the battery and solar panels
It is electrically connected, the ultrasonic sensor and controller are electrically connected, and the motor is electrically connected with the battery, the step
It is electrically connected into motor and controller;
And including step used below:
(1) by bladder is filled with air;
(2) device is placed on lake surface;
(3) start stepper motor and motor, which will start to carry out garbage collection work.
The hull is by hull main body, filter hole, stepper motor mounting rack, spherical guide, motor mounting plate limit
What plate and motor mounting plate limit hole formed, the stepper motor mounting rack is fixedly mounted on hull rear end, the motor
Mounting plate limit plate is fixedly mounted on stepper motor mounting rack, and the spherical guide is located on motor mounting plate limit plate,
The motor mounting plate limit hole is located on motor mounting plate limit plate, and the hull lower end and rear end are evenly distributed with filtering
Hole folds the holding tank of big bar below the hull with big baffle.
The motor mounting plate is by motor mounting plate limited post, motor mounting plate limit base for post, drive rod limit
What column, the second spherical guide and electric machine spacing mounting plate formed, the motor mounting plate limited post is fixedly mounted on motor peace
Loading board limits the lower surface of base for post, and the drive rod limited post is fixedly mounted on the upper table of motor mounting plate limit base for post
Face, the motor mounting plate limit base for post are fixedly installed togather with electric machine spacing mounting plate, and second ball is led
Rail is located on electric machine spacing mounting plate.
It totally two pieces of the solar panels, is symmetrically mounted on hull.
When any one of two ultrasonic sensors in the right generation signal and two, left side ultrasonic sensor does not generate letter
Number, controller driving stepper motor rotates clockwise 30 degree, so that hull be driven to turn left, when two, the left side, supersonic sensing is had a high regard for
What generations signal and when two, the right ultrasonic sensor does not generate signal, controller drives stepper motor to turn counterclockwise
Dynamic 30 degree, so that hull be driven to turn right, when three, left side ultrasonic sensor generation signal, illustrate that hull levels off to parallel bank
Side, controller driving stepper motor rotates counterclockwise 45 degree, so that hull be driven to turn right rapidly, when being reduced to two, left side ultrasound
At least any one generates signal to wave sensor and two, the right ultrasonic sensor does not generate signal, and controller drives stepping
Motor rotates clockwise 15 degree, reduces turn amplitude, after all ultrasonic sensors can't detect signal, controller control
Stepper motor sets back, i.e., motor is parallel to hull, and propeller pushes hull straight trip;When three, the right, ultrasonic sensor is produced
Raw signal illustrates that hull levels off to parallel bank, and controller driving stepper motor rotates clockwise 45 degree, to drive hull fast
Speed is turned left, when be reduced to two ultrasonic sensors in the right at least any one generate signal and two, left side ultrasonic sensor
Do not generate signal, controller driving stepper motor rotates counterclockwise 15 degree, reduces turn amplitude, when all ultrasonic sensors
It is good to can't detect signal, controller control stepper motor sets back, i.e., motor is parallel to hull, and motor pushing hull is straight
Row.
The controller uses singlechip chip, the I/O electric connection of ultrasonic sensor and single-chip microcontroller.
The usefulness of the invention is, the device can in real time, dust man's work is uninterruptedly carried out on the lake surface of park,
Not only the working strength of park staff had been alleviated, but also has beautified lake surface, fine impression is left to tourist;The device is by too
Positive to power with battery two ways, when device is swum on lake surface, solar energy equipment generates electricity, to guarantee the device
Cruise duration;Air bag, solar panels and battery are symmetrically mounted on hull, ensure that the symmetry of device, to make
It smoothly swims in the water surface and is easy to control its movement;Small front apron in device can play expansion and collect area, big baffle
Reduce effect of the water flow to the impact of motor and increase hull front end counterweight, hull is avoided to tilt forward and back;Ultrasonic sensor
It is mounted on position and is higher by hull, to avoid generating error signal because of garbage on water, guarantee higher collection efficiency, hull rear end
It is fitted with ball, it is ensured that the power section of device rear end rotates more stable.
Detailed description of the invention
Attached drawing 1 is overall structure diagram of the invention;
Attached drawing 2 is the structural schematic diagram of side of the present invention;
Attached drawing 3 is the structural schematic diagram of rear end part of the present invention;
Attached drawing 4 is structural schematic diagram when rear of the present invention is observed;
Attached drawing 5 is the structural schematic diagram of hull of the present invention;
Attached drawing 6 is the structural schematic diagram of underside of ship hull of the present invention;
Attached drawing 7 is the structural schematic diagram of motor mounting plate of the present invention and filter screen assembly;
Attached drawing 8 is the transmittance process figure of ultrasonic signal in the present invention.
In figure, 1, ultrasonic sensor, 2, ultrasonic sensor mounting rack, 3, solar panels, 4, the big bar of folding, 5, small gear
Plate, 6, the small bar of folding, 7, big baffle, 8, the big bar of big baffle folding, 9, the small bar of big baffle folding, 10, air bag, 11, filter screen,
12, hull, 1201, hull main body, 1202, filter hole, 1203, stepper motor mounting rack, 1204, spherical guide, 1205, motor
Mounting plate limit plate, 1206, motor mounting plate limit hole, 13, stepper motor, 14, motor drive plate, 15, drive rod, 16, electricity
Machine mounting plate, 1601, motor mounting plate limited post, 1602, motor mounting plate limit base for post, 1603, drive rod limited post,
1604, the second spherical guide, 1605, electric machine spacing mounting plate, 17, cylinder roller bearing, 18, ball, 19, propeller, 20, control
Device processed, 21, battery, 22, motor.
Specific embodiment
A kind of system of automatic cleaning garbage on water, the device including a kind of automatic cleaning garbage on water, is by ultrasonic wave
Sensor 1, solar panels 3, folds big bar 4, small front apron 5, folds small bar 6, is big baffle 7, big ultrasonic sensor mounting rack 2
Baffle folds big bar 8, big baffle folds small bar 9, air bag 10, filter screen 11, hull 12, stepper motor 13, motor drive plate 14,
Drive rod 15, motor mounting plate 16, cylinder roller bearing 17, ball 18, propeller 19, controller 20, battery 21 and motor 22
Composition, the air bag 10 is fixedly mounted on the two sides of hull 12, and the battery 21 is mounted on hull 12, the control
Device 20 processed is mounted on hull 12, and the solar panels 3 are fixedly mounted on hull 12, the battery 21 and controller 20
Positioned at solar panels 3 in the following, the ultrasonic sensor mounting rack 2 is fixedly mounted on hull 12, the ultrasonic wave is passed
Sensor 1 is fixedly mounted on ultrasonic sensor mounting rack 2, and one end of the big bar 4 of folding is fitted to ship by axis
On body 12, the other end of the big bar 4 of folding is installed together by axis with the one end for folding small bar 6, and the folding is small
The other end of bar 6 is installed together with small front apron 5 by axis, and the small front apron 5 is installed together by axis with hull 12, institute
The stepper motor 13 stated is mounted on the rear end of hull 12, the output shaft of the stepper motor 13 and one end of motor drive plate 14
It is fixedly installed togather, the other end of the motor drive plate 14 and one end of drive rod 15 pass through axis connection, the biography
The other end of lever 15 is installed togather by axis with motor mounting plate 16, and the motor mounting plate 16 is rolled by cylinder
Sub- bearing 17 is installed together with hull 12, and the cylinder roller bearing 17 is fixedly mounted on the rear end of hull 12, described
Ball 18 is fitted between hull 12 and motor mounting plate 16, and the motor mounting plate 16 and filter screen 11 are fixedly mounted
Together, the motor 22 is fixedly mounted on motor mounting plate 16, and it is defeated that the propeller 19 is fixedly mounted on motor 22
On shaft, described 7 one end of big baffle is fixedly mounted below hull 12 by axis, and the big baffle folds big bar 8
One end is connect by axis with hull 12, and the big baffle folds big 8 other end of bar and folds the one of small bar 9 by axis and big baffle
End links together, the big baffle fold the other end of small bar 9 and big baffle 7 by axis connection together with, the electricity
Pond 21 and solar panels 3 are electrically connected, and the ultrasonic sensor 1 and controller 20 are electrically connected, the motor 22 with
Battery 21 is electrically connected, and the stepper motor 13 and controller 20 are electrically connected.
The hull 12 is by hull main body 1201, filter hole 1202, stepper motor mounting rack 1203, spherical guide
1204, motor mounting plate limit plate 1205 and motor mounting plate limit hole 1206 form, the stepper motor mounting rack
1203 are fixedly mounted on 12 rear end of hull, and the motor mounting plate limit plate 1205 is fixedly mounted on stepper motor mounting rack
On 1203, the spherical guide 1204 is located on motor mounting plate limit plate 1205, the motor mounting plate limit hole
1206 are located on motor mounting plate limit plate 1205, and 12 lower end of hull and rear end are evenly distributed with filter hole, the hull
12 fold the holding tank of big bar 8 with big baffle below.
The motor mounting plate 16 be by motor mounting plate limited post 1601, motor mounting plate limit base for post 1602,
What drive rod limited post 1603, the second spherical guide 1604 and electric machine spacing mounting plate 1605 formed, the motor mounting plate
Limited post 1601 is fixedly mounted on the lower surface of motor mounting plate limit base for post 1602, and the drive rod limited post 1603 is solid
Dingan County is mounted in the upper surface of motor mounting plate limit base for post 1602, the motor mounting plate limit base for post 1602 and motor
Plate 1605 is mounted to be fixedly installed togather, second spherical guide 1604 is located on electric machine spacing mounting plate 1605.
It totally two pieces of the solar panels 3, is symmetrically mounted on hull 12.
When two, the right ultrasonic sensor 1, any one generates signal and two, left side ultrasonic sensor 1 does not generate
Signal, controller 20 drive stepper motor 13 to rotate clockwise 30 degree, to drive hull 12 to turn left, when two, left side ultrasonic wave
Sensor 1 any one when generating signal and two, the right ultrasonic sensor 1 and not generating signal, controller 20 drives stepping
Motor 13 rotates counterclockwise 30 degree, so that hull 12 be driven to turn right, when three, the left side, ultrasonic sensor 1 generates signal, explanation
Hull 12 levels off to parallel bank, and controller 20 drives stepper motor 13 to rotate counterclockwise 45 degree, to drive hull 12 rapid
Turn right, when be reduced to two, left side ultrasonic sensor 1 at least any one generate signal and two, the right ultrasonic sensor 1
Do not generate signal, controller 20 drives stepper motor 13 to rotate clockwise 15 degree, reduces turn amplitude, when all ultrasonic waves pass
After sensor 1 can't detect signal, controller 20 controls stepper motor 13 and sets back, i.e., motor 22 is parallel to hull 12, spiral shell
Revolving paddle 19 pushes hull 12 to keep straight on;When three ultrasonic sensors 1 in the right generate signal, illustrate that 12 body of ship levels off to parallel bank
Side, controller 20 drive stepper motor 13 rotate clockwise 45 degree, thus drive hull 12 rapidly turn left, when be reduced to the right two
At least any one generates signal to a ultrasonic sensor 1 and two, left side ultrasonic sensor 1 does not generate signal, controller
20 driving stepper motors 13 rotate counterclockwise 15 degree, reduce turn amplitude, when all ultrasonic sensors 1 can't detect signal
Good, controller 20 controls stepper motor 13 and sets back, i.e., motor is parallel to hull, and propeller 19 pushes hull straight trip.
The controller 20 uses 89C51 singlechip chip, the I/O electric connection of ultrasonic sensor 1 and single-chip microcontroller.
Air bag 10 when in use, is full of gas first, which is placed on lake surface by the device, then starts stepping electricity
Machine 13 and motor 22, the device are energized using battery 21 and solar panels 3, can long-play on lake surface, lake surface floating
Rubbish will be pushed into hull, the device will recycle constantly on lake surface carry out dustman's work.
A kind of system of automatic cleaning garbage on water, a kind of method including automatic cleaning garbage on water, this method use
One kind is by ultrasonic sensor 1, ultrasonic sensor mounting rack 2, solar panels 3, the big bar 4 of folding, small front apron 5, the small bar of folding
6, big baffle 7, big baffle fold big bar 8, big baffle folds small bar 9, air bag 10, filter screen 11, hull 12, stepper motor 13,
Motor drive plate 14, drive rod 15, motor mounting plate 16, cylinder roller bearing 17, ball 18, propeller 19, controller 20, electricity
The device for the automatic cleaning garbage on water that pond 21 and motor 22 form, the air bag 10 are fixedly mounted on the two sides of hull 12,
The battery 21 is mounted on hull 12, and the controller 20 is mounted on hull 12, the fixed peace of the solar panels 3
On hull 12, the battery 21 and controller 20 are located at solar panels 3 in the following, the ultrasonic sensor mounting rack
2 are fixedly mounted on hull 12, and the ultrasonic sensor 1 is fixedly mounted on ultrasonic sensor mounting rack 2, described
The one end for folding big bar 4 is fitted on hull 12 by axis, and the other end of the big bar 4 of folding is small by axis and folding
One end of bar 6 is installed together, and the other end of the small bar 6 of folding is installed together with small front apron 5 by axis, and described is small
Baffle 5 is installed together by axis with hull 12, and the stepper motor 13 is mounted on the rear end of hull 12, the stepping electricity
The output shaft of machine 13 and one end of motor drive plate 14 are fixedly installed togather, the other end and biography of the motor drive plate 14
One end of lever 15 is fitted to one by axis and motor mounting plate 16 by axis connection, the other end of the drive rod 15
It rises, the motor mounting plate 16 is installed together by cylinder roller bearing 17 with hull 12, the cylinder roller bearing
17 are fixedly mounted on the rear end of hull 12, and the ball 18 is fitted between hull 12 and motor mounting plate 16, described
Motor mounting plate 16 be fixedly installed togather with filter screen 11, the motor 22 is fixedly mounted on motor mounting plate 16,
The propeller 19 is fixedly mounted on 22 output shaft of motor, and described 7 one end of big baffle is fixedly mounted on hull by axis
Below 12, one end that the big baffle folds big bar 8 is connect by axis with hull 12, and the big baffle folds big bar 8
The other end is linked together by one end that axis folds small bar 9 with big baffle, the big baffle fold the other end of small bar 9 with
Together by axis connection, the battery 21 and solar panels 3 are electrically connected big baffle 7, the ultrasonic sensor 1 with
Controller 20 is electrically connected, and the motor 22 and battery 21 are electrically connected, and the stepper motor 13 and controller 20 are electrically
Connection;
And including step used below:
(1) air bag 10 is full of air;
(2) device is placed on lake surface;
(3) start stepper motor 13 and motor 22, which will start to carry out garbage collection work.
The hull 12 is by hull main body 1201, filter hole 1202, stepper motor mounting rack 1203, spherical guide
1204, motor mounting plate limit plate 1205 and motor mounting plate limit hole 1206 form, the stepper motor mounting rack
1203 are fixedly mounted on 12 rear end of hull, and the motor mounting plate limit plate 1205 is fixedly mounted on stepper motor mounting rack
On 1203, the spherical guide 1204 is located on motor mounting plate limit plate 1205, the motor mounting plate limit hole
1206 are located on motor mounting plate limit plate 1205, and 12 lower end of hull and rear end are evenly distributed with filter hole, the hull
12 fold the holding tank of big bar 8 with big baffle below.
The motor mounting plate 16 be by motor mounting plate limited post 1601, motor mounting plate limit base for post 1602,
What drive rod limited post 1603, the second spherical guide 1604 and electric machine spacing mounting plate 1605 formed, the motor mounting plate
Limited post 1601 is fixedly mounted on the lower surface of motor mounting plate limit base for post 1602, and the drive rod limited post 1603 is solid
Dingan County is mounted in the upper surface of motor mounting plate limit base for post 1602, the motor mounting plate limit base for post 1602 and motor
Plate 1605 is mounted to be fixedly installed togather, second spherical guide 1604 is located on electric machine spacing mounting plate 1605.
It totally two pieces of the solar panels 3, is symmetrically mounted on hull 12.
When two, the right ultrasonic sensor 1, any one generates signal and two, left side ultrasonic sensor 1 does not generate
Signal, controller 20 drive stepper motor 13 to rotate clockwise 30 degree, to drive hull 12 to turn left, when two, left side ultrasonic wave
Sensor 1 any one when generating signal and two, the right ultrasonic sensor 1 and not generating signal, controller 20 drives stepping
Motor 13 rotates counterclockwise 30 degree, so that hull 12 be driven to turn right, when three, the left side, ultrasonic sensor 1 generates signal, explanation
Hull 12 levels off to parallel bank, and controller 20 drives stepper motor 13 to rotate counterclockwise 45 degree, to drive hull 12 rapid
Turn right, when be reduced to two, left side ultrasonic sensor 1 at least any one generate signal and two, the right ultrasonic sensor 1
Do not generate signal, controller 20 drives stepper motor 13 to rotate clockwise 15 degree, reduces turn amplitude, when all ultrasonic waves pass
After sensor 1 can't detect signal, controller 20 controls stepper motor 13 and sets back, i.e., motor 22 is parallel to hull 12, spiral shell
Revolving paddle 19 pushes hull 12 to keep straight on;When three ultrasonic sensors 1 in the right generate signal, illustrate that 12 body of ship levels off to parallel bank
Side, controller 20 drive stepper motor 13 rotate clockwise 45 degree, thus drive hull 12 rapidly turn left, when be reduced to the right two
At least any one generates signal to a ultrasonic sensor 1 and two, left side ultrasonic sensor 1 does not generate signal, controller
20 driving stepper motors 13 rotate counterclockwise 15 degree, reduce turn amplitude, when all ultrasonic sensors 1 can't detect signal
Good, controller 20 controls stepper motor 13 and sets back, i.e., motor is parallel to hull, and propeller 19 pushes hull straight trip.
The controller 20 uses 89C51 singlechip chip, the I/O electric connection of ultrasonic sensor 1 and single-chip microcontroller.
For the ordinary skill in the art, introduction according to the present invention, do not depart from the principle of the present invention with
In the case where spirit, changes, modifications that embodiment is carried out, replacement and variant still fall within protection scope of the present invention it
It is interior.