阅读说明：本技术 一种新型猪舍清理机器人及其清理方法 (Novel pigsty cleaning robot and cleaning method thereof ) 是由 路卫国 王秀敏 路遥 马站起 宋洋 于 2018-08-23 设计创作，主要内容包括：本发明提供了一种新型猪舍清理机器人及其清理方法,清理机器人包括由上、中、下三层板组成的车体本体、在下层板左右两侧设置的驱动轮、设置在下层板上的刮除装置、控制刮除装置刮除的升降装置、控制刮除装置运行的第一动力装置、控制升降装置运作的第二动力装置、控制驱动轮行走的第三动力装置以及设置在中层板上的PLC控制模块、RFID通信模块和设置在上层板上的水箱,PLC控制模块联合RFID通信模块控制各装置的运作,水箱内的水通过喷洒装置将水源喷洒至刮除装置处。本发明解决大规模养猪场中猪舍清理难、环境卫生差、水源浪费多、人工成本高等问题。(The invention provides a novel pigsty cleaning robot and a cleaning method thereof, the cleaning robot comprises a vehicle body consisting of an upper layer plate, a middle layer plate and a lower layer plate, driving wheels arranged on the left side and the right side of the lower layer plate, a scraping device arranged on the lower layer plate, a lifting device for controlling the scraping of the scraping device, a first power device for controlling the operation of the scraping device, a second power device for controlling the operation of the lifting device, a third power device for controlling the traveling of the driving wheels, a PLC (programmable logic controller) module arranged on the middle layer plate, an RFID (radio frequency identification) communication module and a water tank arranged on the upper layer plate, wherein the PLC control module is combined with the RFID communication module to control the operation of each device, and water in the water tank is sprayed to the scraping device through a spraying device. The invention solves the problems of difficult piggery cleaning, poor environmental sanitation, much water source waste, high labor cost and the like in a large-scale pig farm.)

1. The utility model provides a novel pig house clearance robot which characterized in that: the water tank comprises a vehicle body consisting of an upper layer plate, a middle layer plate and a lower layer plate, driving wheels (8) arranged on the left side and the right side of the lower layer plate (6), a scraping device arranged on the lower layer plate (6), a lifting device (30) for controlling the scraping device to scrape, a first power device for controlling the scraping device to run, a second power device for controlling the lifting device (30) to run, a third power device for controlling the driving wheels (8) to run, and a PLC control module (14) arranged on the middle layer plate (4), an RFID communication module (33) and a water tank (1) arranged on the upper layer plate 2, wherein the PLC control module (14) is combined with the RFID communication module (33) to control the running of each device, and water in the water tank (1) is sprayed to the scraping device through a spraying device.

2. The novel pigsty cleaning robot as claimed in claim 1, wherein: scraping device including two turning arms (7) of hypoplastron (6) front end that the symmetry set up, every turning arm (7) and the perpendicular rigid coupling of a push pedal (5), every turning arm (7) all drive corresponding push pedal (5) and rotate the setting around the axle on plywood (6) down, two turning arms (7) under the unoperated state are a sharp and arrange, two push pedal (5) set up the left and right sides in hypoplastron (6), two turning arms (7) parallel arrangement under the operating condition, two push pedal (5) set up the front side of plywood (6) down.

3. The novel pigsty cleaning robot as claimed in claim 2, wherein: the lifting device (30) comprises a screw rod (36), a nut (37) matched with the screw rod (36), a guide bearing (38) for limiting the rotation of the nut (37), a linear bearing (39) and a transmission guide post (40), the second power device comprises a stepping lifting motor (26) and a lifting motor driver (23), the lifting motor driver (23) controls the operation of the stepping lifting motor (26), the screw rod (36) is fixed on an output shaft of the stepping lifting motor (26), the stepping lifting motor (26) is fixed on the upper part of a hollow motor support (41), the lower part of the motor support (41) is fixed on the lower layer plate (6), the nut (37) matched with the screw rod (36) is arranged in the hollow motor support (41), and the nut (37) is fixedly connected with one end of the transmission guide post (40), the other end of the transmission guide post (40) penetrates through the lower layer plate (6) to be connected with the front auxiliary wheel (32), the guide bearing (38) is fixed on the inner wall of the motor support (41), a linear bearing (39) is arranged between the inner wall of the hollow motor support (41) and the transmission guide post (40), and the linear bearing (39) is fixed on the lower layer plate (6).

4. The novel pigsty cleaning robot as claimed in claim 3, wherein: the first power device comprises two corner speed reducing motors (31), a left crank arm corner motor driver (24), a right crank arm corner motor driver (27), a crank arm limiting sensor (18), a left crank arm resetting sensor (21) and a right crank arm resetting sensor (19), wherein the two corner speed reducing motors (31) respectively drive a crank arm (7) to rotate, the two corner motor drivers control the operation of the two corner speed reducing motors (31), and the crank arm limiting sensor (18) and the two resetting sensors control the rotating angles of the two crank arms (7);

the third power device comprises two driving wheel speed reducing motors (25), a left wheel motor driver (29) and a right wheel motor driver (28), the two driving wheel speed reducing motors (25) respectively drive one driving wheel (8) to operate, and the left wheel motor driver and the right wheel motor driver control the operation of the two driving wheel speed reducing motors (25).

5. The novel pigsty cleaning robot as claimed in claim 4, wherein: the spraying device comprises a water pump (22) fixed on the lower plate (6) and a water pump driver (17) fixed on the middle plate (4), wherein the water pump driver (17) controls the operation of the water pump (22), a water pipe is arranged on each push plate (5), and water pumped out of the water tank (1) by the water pump (22) is sprayed to a scraping position through the water pipe.

6. The novel pigsty cleaning robot as claimed in claim 5, wherein: the rear end of plywood (6) is equipped with a plunger sensor (11) down the front and back end of plywood (6) bottom is equipped with locomotive AGV magnetic navigation sensor (20) and rear of a vehicle AGV magnetic navigation sensor (12) respectively down the front and back end of medium plate (4) respectively is equipped with an ultrasonic sensor (35), is equipped with lithium cell (13) for the power supply of various power consumption device on plywood (6) down, plunger sensor (11) and ground contactless under the normal walking state of robot.

7. The novel pigsty cleaning robot as claimed in claim 6, wherein: the top of water tank (1) is equipped with water tank lid (10), opening and close of water tank lid (10) is by fourth power device drive control, fourth drive device including driving water tank lid (10) pivoted water tank lid motor (15), water tank lid motor driver (16) and level sensor (34), water tank lid motor (15) set up on water tank (1), level sensor (34) set up the well lower part in water tank (1), all motors and sensor all are connected with PLC control module (14) electricity.

8. The cleaning method of the novel pigsty cleaning robot as claimed in claim 7, characterized in that:

(1) after the robot is powered on, the PLC control module (14) operates according to an initial state, firstly, a plunger sensor (11) and two crank arm reset sensors are utilized to enable each driving motor to find a zero position state according to requirements, namely, a lower layer plate (6) of the robot is in a horizontal state under the support of a front auxiliary wheel (32) and two driving wheels (8), two crank arms (7) are arranged in a straight line, two push plates (5) are arranged on the left side and the right side of the lower layer plate (6), and the two push plates (5) are not in contact with the ground;

(2) the first power device is started, the two corner speed reducing motors (31) respectively drive a group of crank arms (7) and the push plate (5) to rotate towards the front side of the lower layer plate (6), when the two crank arms (7) are in a parallel state, the crank arm limit sensor (18) is triggered, the crank arm limit sensor (18) responds to action, the two corner speed reducing motors (31) stop moving, the PLC control module (14) and the RFID communication module (33) coordinately control the second power device to start, the lifting motor driver (23) drives the stepping lifting motor (26) to operate, the stepping lifting motor (26) operates to drive the lead screw (36) to rotate, the lead screw (36) drives the screw nut (37) to move, the screw nut (37) is fixed on the transmission guide post (40), the transmission guide post (40) is fixed on the front auxiliary wheel (32), and the front auxiliary wheel (32) is in contact with the ground, so that the screw nut (37) does not move to give a reaction force to drive the screw nut (36) to rotate and simultaneously drive the motor support (6 The front ends of the seat (41) and the lower layer plate (6) descend, the lower layer plate (6) is in a state of low front and high back, and the two push plates (5) are in contact with the ground;

(3) starting a third power device, driving a push plate (5) of the robot to push forwards to scrape sundries on the ground by two driving wheels (8), synchronously starting a spraying device in the pushing and scraping process, spraying water pumped out of a water tank (1) by a water pump (22) to a scraping position through a water pipe, realizing reciprocating pushing and scraping actions along a certain direction by using a small amount of water source, and uniformly cleaning the sundries on the ground to a specified position;

(4) second power device operates and drives lead screw (36) antiport, lower plywood (6) front end descends, lower plywood (6) resume the horizontality, two push pedal (5) and ground contactless this moment, start first power device, two corner gear motor (31) drive a set of crank arm (7) and push pedal (5) respectively to the both sides rotation of plywood (6) down, when two crank arm (7) are a rectilinear state, trigger two crank arm reset sensor, two crank arm reset spacing sensor response actions, two corner gear motor (31) stop motion, the robot accomplishes the clearance task, treat next use.

9. The cleaning method according to claim 8, characterized in that: in the cleaning task, a headstock AGV magnetic navigation sensor (20) and a tailstock AGV magnetic navigation sensor (12) which are arranged at the front end and the rear end of a lower layer plate (6) are used for recognizing magnetic stripes through a magnetic navigation system to finish the track motion of the robot;

in the cleaning task, if the front or the rear of the robot meets an obstacle, the ultrasonic sensor (35) feeds back a signal to the control system according to the detection distance and judges whether to continue walking or stop.

10. A method of cleaning as claimed in claim 9, wherein: in the cleaning task, if water tank (1) lacks water, level sensor (34) response action during lack of water, through PLC control module (14) and RFID communication module (33) coordinated control robot to the assigned position after, water tank lid motor (15) drive water tank lid (10) are opened, carry out the moisturizing task, wait that water fills up the back, water tank lid (10) are closed, continue to accomplish the cleaning task through the instruction.

Technical Field

The invention belongs to the field of agricultural intelligent equipment, and particularly relates to a novel pigsty cleaning robot and a cleaning method thereof.

Background

At present, in the animal husbandry developed based on the modern agricultural background, manual labor is mostly used as service support, semi-automatic service equipment is introduced into a small number of animal husbandry places with large scales, and for piggery cleaning work in large-scale pig farms, cleaning is still performed by manually using tools and consuming a large amount of water resources, so that the piggery cleaning work can be performed cleanly, the time consumption is long, the cost is high, and the efficiency is low. Aiming at the pigsty cleaning work related in the field, the invention develops a novel pigsty cleaning robot which is convenient to use, thorough in cleaning, energy-saving and environment-friendly.

Disclosure of Invention

In view of the above, the invention aims to provide a novel pigsty cleaning robot and a cleaning method thereof, which solve the problems existing in the pigsty cleaning technology under the existing conditions, namely the problems of difficult pigsty cleaning, poor environmental sanitation, much water source waste, high labor cost and the like in a large-scale pig farm.

In order to achieve the purpose, the technical scheme of the invention is realized as follows:

the utility model provides a novel pig house clearance robot, includes by the automobile body that upper, middle, lower three-layer board is constituteed, the drive wheel that the plywood left and right sides set up under, set up scraping device on the plywood down, the elevating gear that control scraping device struck off, the first power device of control scraping device operation, the second power device of control elevating gear function, the third power device of control drive wheel walking and set up PLC control module, the RFID communication module on middle plywood and set up the water tank on the plywood, PLC control module unite the function of each device of RFID communication module control, the water in the water tank spray the water source to scraping device department through sprinkler.

Further, scraping device including two turning arms of the lower plywood front end that the symmetry set up, every turning arm and the perpendicular rigid coupling of a push pedal, every the turning arm all drive corresponding push pedal and rotate the setting around the axle on the lower floor's board, two turning arms under the unoperated state are a straight line and arrange, two push pedals set up the left and right sides at the lower plywood, two turning arm parallel arrangement under the operating condition, two push pedal settings are at the front side of plywood under.

Furthermore, the lifting device comprises a screw rod, a nut matched with the screw rod, a guide bearing for limiting the rotation of the nut, a linear bearing and a transmission guide post, the second power device comprises a stepping lifting motor and a lifting motor driver, the lifting motor driver controls the operation of the stepping lifting motor, the screw rod is fixed on an output shaft of the stepping lifting motor, the stepping lifting motor is fixed on the upper part of a hollow motor support, the lower part of the motor support is fixed on a lower plate, the nut matched with the screw rod is arranged in the hollow motor support, the nut is fixedly connected with one end of the transmission guide post, the other end of the transmission guide post penetrates through the lower plate to be connected with a front auxiliary wheel, the guide bearing is fixed on the inner wall of the motor support, and the linear bearing is arranged between the inner wall of the hollow motor support and the transmission guide post, the linear bearing is fixed on the lower layer plate.

Furthermore, the first power device comprises two corner speed reducing motors, a left corner arm corner motor driver, a right corner arm corner motor driver, a corner arm limit sensor, a left corner arm reset sensor and a right corner arm reset sensor, wherein the two corner speed reducing motors respectively drive a corner arm to rotate, the two corner motor drivers control the operation of the two corner speed reducing motors, and the corner arm limit sensor and the two reset sensors control the rotation angles of the two corner arms;

the third power device comprises two driving wheel speed reducing motors, a left wheel motor driver and a right wheel motor driver, wherein the two driving wheel speed reducing motors respectively drive one driving wheel to operate, and the left wheel motor driver and the right wheel motor driver control the operation of the two driving wheel speed reducing motors.

Furthermore, the spraying device comprises a water pump fixed on the lower plate and a water pump driver fixed on the middle plate, the water pump driver controls the operation of the water pump, a water pipe is arranged on each push plate, and water pumped out of the water tank by the water pump is sprayed to the scraping position through the water pipe.

Further, the rear end of plywood is equipped with a plunger sensor down the front and back end of plywood bottom is equipped with locomotive AGV magnetic navigation sensor and rear of a vehicle AGV magnetic navigation sensor respectively down the front and back end of medium plate respectively is equipped with an ultrasonic sensor, is equipped with the lithium cell for the power supply of various power consumption device on the plywood down, plunger sensor and ground contactless under the normal walking state of robot.

Furthermore, the top of water tank is equipped with the water tank lid, opening and close of water tank lid is by fourth power device drive control, fourth drive arrangement including driving water tank lid pivoted water tank lid motor, water tank lid motor driver and level sensor, the water tank lid motor set up on the water tank, level sensor set up the well lower part at the water tank, all motors and sensor all are connected with PLC control module electricity.

A cleaning method of a novel pigsty cleaning robot comprises

(1) After the robot is powered on, the PLC control module operates according to an initial state, firstly, a plunger sensor and two crank arm reset sensors are utilized to enable each driving motor to find a zero position state according to requirements, namely a lower layer plate of the robot is in a horizontal state under the support of a front auxiliary wheel and two driving wheels, the two crank arms are arranged in a straight line, two push plates are arranged on the left side and the right side of the lower layer plate, and the two push plates are not in contact with the ground;

(2) the method comprises the steps that a first power device is started, two corner speed reducing motors respectively drive a group of crank arms and push plates to rotate towards the front side of a lower layer plate, when the two crank arms are in a parallel state, a crank arm limiting sensor is triggered, the crank arm limiting sensor responds, the two corner speed reducing motors stop moving, a PLC (programmable logic controller) control module and an RFID (radio frequency identification) communication module coordinately control a second power device to start, a lifting motor driver drives a stepping lifting motor to operate, the stepping lifting motor operates to drive a lead screw to rotate, the lead screw drives a nut to move, the nut is fixed on a transmission guide pillar, the transmission guide pillar is fixed on a front auxiliary wheel, and the front auxiliary wheel is in contact with the ground, so that the nut does not act to provide a reaction force of the lead screw, the lead screw rotates and simultaneously drives a motor support and the front end of the lower layer plate;

(3) starting a third power device, driving a push plate of the robot to push and scrape impurities on the ground forwards by two driving wheels, synchronously starting a spraying device in the pushing and scraping process, pumping water in a water tank by a water pump, spraying the water to a scraping position through a water pipe, realizing reciprocating pushing and scraping actions along a certain direction by using a small amount of water source, and uniformly cleaning the impurities on the ground to a specified position;

(4) the second power device operates to drive the screw rod to rotate reversely, the front end of the lower layer plate descends, the lower layer plate recovers to the horizontal state, two push plates are not in contact with the ground at the moment, the first power device is started, two corner speed reducing motors respectively drive a group of crank arms and the two sides of the lower layer plate of the push plates to rotate, when the two crank arms are in a linear state, two crank arm reset sensors are triggered, the two crank arms reset limiting sensors respond, the two corner speed reducing motors stop motion, the robot completes a cleaning task and treats the next use.

Further, in the cleaning task, a head AGV magnetic navigation sensor and a tail AGV magnetic navigation sensor which are arranged at the front end and the rear end of a lower layer plate of the vehicle body are used, and a magnetic navigation system is used for recognizing magnetic stripes to finish the track motion of the robot;

in the cleaning task, if the front or the rear of the robot meets an obstacle, the ultrasonic sensor feeds back a signal to the control system according to the detection distance and judges whether to continue walking or stop.

Furthermore, in the cleaning task, if the water tank is lack of water, the liquid level sensor responds to the action during the water shortage, after the robot is coordinately controlled to the specified position through the PLC control module and the RFID communication module, the water tank cover motor drives the water tank cover to be opened, the water supplementing task is carried out, after the water is filled, the water tank cover is closed, and the cleaning task is continuously completed through instructions.

Compared with the prior art, the novel pigsty cleaning robot has the following advantages:

the novel pigsty cleaning robot is connected with robot hardware through APP software, and remote internet-of-things multi-machine cooperative work is achieved. APP software is used as a control unit of the system, and communication identification and data processing are carried out through an RFID communication module on a robot body, one mode can be that a task function can be completed according to a preset track by means of an AGV magnetic navigation system, the other mode can realize accurate remote control movement through a software positioning function, meanwhile, a PLC control module is used as a core unit to realize accurate control on each motor, complete signal processing among sensors, and coordinate logic relation among driving modules; the robot power source adopts an energy-saving and environment-friendly lithium battery pack, and the load can be driven for more than 3 hours after single charging for 8 hours; controlling the walking and turning of the robot by using a direct current speed reduction motor; controlling the lifting and the action of the robot by utilizing a stepping speed reducing motor; the robot body frame is made of metal and composite materials, is light in weight and can carry water sources below 50kg to move; the robot adopts double-arm type to push away and scrape cleaning device, uses less water source to assist the clearance task, pushes away excrement and urine and debris to the assigned position, both accomplished the clearance task, provides preparation for next process simultaneously.

Drawings

The accompanying drawings, which are incorporated in and constitute a part of this specification, illustrate an embodiment of the invention and, together with the description, serve to explain the invention and not to limit the invention. In the drawings:

fig. 1 is a schematic axial view illustrating a crank arm of a novel pigsty cleaning robot in a reset state according to an embodiment of the invention;

FIG. 2 is a schematic axial view illustrating a state in which a crank arm of the novel piggery cleaning robot according to an embodiment of the present invention is extended;

FIG. 3 is an isometric view of the assembly of FIG. 1 with portions broken away;

FIG. 4 is an isometric view of the assembly of FIG. 3 with portions broken away;

FIG. 5 is a front view of FIG. 4

FIG. 6 is a top view of FIG. 4

Fig. 7 is a schematic structural diagram of the lifting device.

Description of reference numerals:

1-water tank, 2-upper plate, 3-upright post, 4-middle plate, 5-push plate, 6-lower plate, 7-crank arm, 8-driving wheel, 9-rear auxiliary wheel, 10-water tank cover, 11-plunger sensor, 12-tailstock AGV magnetic navigation sensor, 13-lithium battery, 14-PLC control module, 15-water tank cover motor, 16-water tank cover motor driver, 17-water pump driver, 18-crank arm limit sensor, 19-right crank arm reset sensor, 20-headstock AGV magnetic navigation sensor, 21-left crank arm reset sensor, 22-water pump, 23-lifting motor driver, 24-left crank arm corner motor driver, 25-driving wheel reducing motor, 26-stepping lifting motor, 27-right turning arm corner motor driver, 28-right wheel motor driver, 29-left wheel motor driver, 30-lifting device, 31-turning angle speed reducing motor, 32-front auxiliary wheel, 33-RFID communication module, 34-liquid level sensor, 35-ultrasonic sensor, 36-screw rod, 37-screw nut, 38-guide bearing, 39-linear bearing, 40-transmission guide post and 41-motor base.

Detailed Description

It should be noted that the embodiments and features of the embodiments may be combined with each other without conflict.

In addition, the RFID communication module mentioned in the embodiment of the present invention generally refers to a module having a function of supporting remote identification.

The present invention will be described in detail below with reference to the embodiments with reference to the attached drawings.

As shown in fig. 1-7, a novel pigsty cleaning robot comprises a vehicle body consisting of an upper plate, a middle plate and a lower plate, driving wheels 8 arranged on the left and right sides of the lower plate 6, a scraping device arranged on the lower plate 6, a lifting device 30 for controlling the scraping of the scraping device, a first power device for controlling the operation of the scraping device, a second power device for controlling the operation of the lifting device 30, a third power device for controlling the traveling of the driving wheels 8, a PLC control module 14 arranged on the middle plate 4, an RFID communication module 33 and a water tank 1 arranged on the upper plate 2, wherein the PLC control module 14 controls the operation of each device in combination with the RFID communication module 33, and water in the water tank 1 is sprayed to the scraping device through a spraying device.

The scraping device comprises two crank arms 7 at the front end of a lower plate 6, wherein the crank arms 7 are symmetrically arranged, each crank arm 7 is fixedly connected with one push plate 5 vertically, each crank arm 7 drives the corresponding push plate 5 to rotate around a shaft on the lower plate 6, the two crank arms 7 under the non-working state are arranged in a straight line, the two push plates 5 are arranged on the left side and the right side of the lower plate 6, the two crank arms 7 under the working state are arranged in parallel, and the two push plates 5 are arranged on the front side of the lower plate 6.

The lifting device 30 comprises a screw rod 36, a nut 37 matched with the screw rod 36, a guide bearing 38 for limiting the rotation of the nut 37, a linear bearing 39 and a transmission guide post 40, the second power device comprises a stepping lifting motor 26 and a lifting motor driver 23, the lifting motor driver 23 controls the operation of the stepping lifting motor 26, the screw rod 36 is fixed on an output shaft of the stepping lifting motor 26, the stepping lifting motor 26 is fixed on the upper part of a hollow motor support 41, the lower part of the motor support 41 is fixed on the lower plate 6, the nut 37 matched with the screw rod 36 is arranged in the hollow motor support 41, the nut 37 is fixedly connected with one end of the transmission guide post 40, the other end of the transmission guide post 40 penetrates through the lower plate 6 to be connected with the front auxiliary wheel 32, the guide bearing 38 is fixed on the inner wall of the motor support 41, a linear bearing 39 is arranged between the inner wall of the hollow motor support 41 and the transmission guide post 40, and the linear bearing 39 is fixed on the lower plate 6.

The first power device comprises two corner speed reducing motors 31, a left crank arm corner motor driver 24, a right crank arm corner motor driver 27, a crank arm limit sensor 18, a left crank arm reset sensor 21 and a right crank arm reset sensor 19, wherein the two corner speed reducing motors 31 respectively drive a crank arm 7 to rotate, the two corner motor drivers control the operation of the two corner speed reducing motors 31, and the crank arm limit sensor 18 and the two reset sensors control the rotation angles of the two crank arms 7;

the third power device comprises two driving wheel speed reducing motors 25, a left wheel motor driver 29 and a right wheel motor driver 28, wherein the two driving wheel speed reducing motors 25 respectively drive one driving wheel 8 to operate, and the left wheel motor driver and the right wheel motor driver control the operation of the two driving wheel speed reducing motors 25.

The spraying device comprises a water pump 22 fixed on the lower plate 6 and a water pump driver 17 fixed on the middle plate 4, wherein the water pump driver 17 controls the operation of the water pump 22, a water pipe is arranged on each push plate 5, and the water pump 22 pumps water in the water tank 1 and sprays the water to a scraping position through the water pipe.

The rear end of lower plywood 6 is equipped with a plunger sensor 11 the front and back end of lower plywood 6 bottom is equipped with locomotive AGV magnetic navigation sensor 20 and rear of a vehicle AGV magnetic navigation sensor 12 respectively the front and back end of medium plate 4 respectively is equipped with an ultrasonic sensor 35, is equipped with lithium cell 13 for the power supply of various power consumption device under on plywood 6, plunger sensor 11 and ground contactless under the normal walking state of robot.

The top of water tank 1 is equipped with tank lid 10, the opening and close of tank lid 10 is by fourth power device drive control, fourth drive device including drive tank lid 10 pivoted tank lid motor 15, tank lid motor driver 16 and level sensor 34, tank lid motor 15 set up on water tank 1, level sensor 34 set up the well lower part at water tank 1, all motors and sensors all are connected with PLC control module 14 electricity.

The lower plate 6 is the foundation of the whole robot and forms a vehicle body outline structure with the middle plate 4 and the upper plate 2 through the upright posts 3.

Two rear auxiliary wheels 9 are arranged at the bottom of the lower plate 5, the rear auxiliary wheels 9 are not in contact with the ground in the normal walking state of the robot, and when the vehicle body inclines or collides, the balance of the vehicle body is protected in an auxiliary mode, and the side-turning or backward-leaning state is prevented.

A cleaning method of a novel pigsty cleaning robot,

(1) after the robot is powered on, the PLC control module 14 operates according to an initial state, firstly, the plunger sensor 11 and the two crank arm reset sensors are utilized to enable each driving motor to find a zero position state according to requirements, namely, a lower layer plate 6 of the robot is in a horizontal state under the support of the front auxiliary wheel 32 and the two driving wheels 8, the two crank arms 7 are arranged in a straight line, the two push plates 5 are arranged on the left side and the right side of the lower layer plate 6, and the two push plates 5 are not in contact with the ground;

(2) starting a first power device, driving a group of crank arms 7 and a push plate 5 to rotate towards the front side of a lower layer plate 6 by two corner speed reducing motors 31 respectively, triggering a crank arm limit sensor 18 when the two crank arms 7 are in a parallel state, enabling the crank arm limit sensor 18 to respond, stopping the two corner speed reducing motors 31, controlling a second power device to start by a PLC (programmable logic controller) control module 14 and an RFID (radio frequency identification) communication module 33 in a coordinated mode, driving a stepping lifting motor driver 23 to drive a stepping lifting motor 26 to operate, driving a screw rod 36 to rotate by the operation of the stepping lifting motor 26, driving a nut 37 to move by the screw rod 36, fixing the nut 37 on a transmission guide pillar 40, fixing the transmission guide pillar 40 on a front auxiliary wheel 32, enabling the front auxiliary wheel 32 to be in contact with the ground, enabling the screw rod 36 to rotate by the counter-acting force of the screw rod 37 by the nut 37, driving a motor support (41) and the front end of, at the moment, the two push plates 5 are contacted with the ground;

(3) starting a third power device, driving the push plate 5 of the robot to push and scrape impurities on the ground forwards by the two driving wheels 8, synchronously starting the spraying device in the pushing and scraping process, pumping water in the water tank 1 by the water pump 22, spraying the water to a scraping position through a water pipe, realizing reciprocating pushing and scraping actions along a certain direction by using a small amount of water source, and uniformly cleaning the impurities on the ground to a specified position;

(4) the second power device operates and drives 36 reverse rotations of lead screw, 6 front ends of lower floor's board descend, lower floor's board 6 resumes the horizontality, two push pedal 5 and ground contactless this moment, start first power device, two corner gear motor 31 drive a set of crank arm 7 respectively and push pedal 5 down the both sides of plywood 6 rotatory, when two crank arms 7 are a linear state, trigger two crank arm reset sensor, two crank arm reset spacing sensor response actions, two corner gear motor 31 stop motion, the robot accomplishes the clearance task, treat next use.

In the cleaning task, the magnetic navigation sensors 20 and 12 of the front AGV and the rear AGV which are arranged at the front end and the rear end of the lower layer plate 6 are used for recognizing magnetic stripes through a magnetic navigation system to complete the track motion of the robot;

in the cleaning task, if the front or the rear of the robot encounters an obstacle, the ultrasonic sensor 35 feeds back a signal to the control system according to the detection distance, and judges whether to continue walking or stop.

In the cleaning task, if the water tank is lack of water, the liquid level sensor 34 responds to the action during the water shortage, after the robot is coordinately controlled to reach the designated position through the PLC control module 14 and the RFID communication module 33, the water tank cover motor 15 drives the water tank cover 10 to be opened, the water supplementing task is carried out, after the water is filled, the water tank cover 10 is closed, and the cleaning task is continuously completed through instructions.

The above description is only for the purpose of illustrating the preferred embodiments of the present invention and is not to be construed as limiting the invention, and any modifications, equivalents, improvements and the like that fall within the spirit and principle of the present invention are intended to be included therein.