CN108056711A - A kind of wall clean robot control method and control system - Google Patents
A kind of wall clean robot control method and control system Download PDFInfo
- Publication number
- CN108056711A CN108056711A CN201711280625.8A CN201711280625A CN108056711A CN 108056711 A CN108056711 A CN 108056711A CN 201711280625 A CN201711280625 A CN 201711280625A CN 108056711 A CN108056711 A CN 108056711A
- Authority
- CN
- China
- Prior art keywords
- axis
- wall
- cleaning robot
- axis cylinder
- suction cup
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 32
- 238000004140 cleaning Methods 0.000 claims abstract description 410
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims abstract description 98
- 230000009194 climbing Effects 0.000 claims abstract description 34
- 239000013505 freshwater Substances 0.000 claims abstract description 5
- 230000033001 locomotion Effects 0.000 claims description 28
- 239000010865 sewage Substances 0.000 claims description 18
- 230000001360 synchronised effect Effects 0.000 claims description 11
- 235000011034 Rubus glaucus Nutrition 0.000 claims description 6
- 235000009122 Rubus idaeus Nutrition 0.000 claims description 6
- 240000007651 Rubus glaucus Species 0.000 claims description 5
- 244000235659 Rubus idaeus Species 0.000 claims 1
- 239000011521 glass Substances 0.000 abstract description 12
- 238000005096 rolling process Methods 0.000 description 6
- 238000012545 processing Methods 0.000 description 3
- 230000009286 beneficial effect Effects 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 2
- 230000015572 biosynthetic process Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000003786 synthesis reaction Methods 0.000 description 2
- 238000004891 communication Methods 0.000 description 1
- 238000004590 computer program Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
Classifications
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L11/00—Machines for cleaning floors, carpets, furniture, walls, or wall coverings
- A47L11/38—Machines, specially adapted for cleaning walls, ceilings, roofs, or the like
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L11/00—Machines for cleaning floors, carpets, furniture, walls, or wall coverings
- A47L11/40—Parts or details of machines not provided for in groups A47L11/02 - A47L11/38, or not restricted to one of these groups, e.g. handles, arrangements of switches, skirts, buffers, levers
- A47L11/4011—Regulation of the cleaning machine by electric means; Control systems and remote control systems therefor
Landscapes
- Manipulator (AREA)
Abstract
本发明提供了一种墙壁清洁机器人控制方法,检测墙壁清洁机器人是否处于清洁区域,若是,则启动清洁模式,使墙壁清洁机器人固定在墙壁表面上时,以进行墙壁清洁作业;当清洁模式运行时,控制清水抽水泵和驱动电机工作,将清水集水箱的水抽出至用于清洗墙壁表面的清洁板,通过驱动电机驱动清洁板上的滚刷转动并在清水的辅助下清洗墙壁表面,当攀爬模式运行时,控制X轴气缸进行移动和/或控制Y轴气缸进行移动,以使所述墙壁清洁机器人攀爬至下一个清洁区域,从而在下一个清洁区域进行清洁。本发明代替人工清洗玻璃墙壁,从而实现玻璃墙壁清洁作业的自动化,同时提高清洗效率。本发明还提供了一种墙壁清洁机器人控制系统。
The invention provides a method for controlling a wall cleaning robot, which detects whether the wall cleaning robot is in the cleaning area, and if so, starts the cleaning mode, so that the wall cleaning robot can be fixed on the wall surface to perform wall cleaning operations; when the cleaning mode is running , control the work of the fresh water pump and the drive motor, pump the water from the clean water collection tank to the cleaning plate used to clean the wall surface, drive the roller brush on the cleaning plate to rotate through the drive motor and clean the wall surface with the help of clean water, when climbing When running in climbing mode, the X-axis cylinder is controlled to move and/or the Y-axis cylinder is controlled to move, so that the wall cleaning robot climbs to the next cleaning area, so as to perform cleaning in the next cleaning area. The invention replaces the manual cleaning of the glass wall, thereby realizing the automation of the cleaning operation of the glass wall and improving the cleaning efficiency at the same time. The invention also provides a wall cleaning robot control system.
Description
技术领域technical field
本发明涉及清洁设备技术领域,尤其是涉及一种墙壁清洁机器人控制方法及控制系统。The invention relates to the technical field of cleaning equipment, in particular to a control method and a control system for a wall cleaning robot.
背景技术Background technique
目前,随着社会的发展,高楼大厦等建筑大多采用玻璃墙壁作为外墙,玻璃墙壁为城市增添了现代化气息的同时,需要定期进行清洁以保持良好的透光性。At present, with the development of society, most buildings such as high-rise buildings use glass walls as exterior walls. While glass walls add a modern atmosphere to the city, they need to be cleaned regularly to maintain good light transmission.
现有技术中,玻璃墙壁的清洁依赖于人工清洗,工人们通过吊篮悬吊或保鲜绳将自己悬挂在高楼外以进行玻璃墙壁的清洁,高空作业不仅危险程度高,而且清洗效率低;因此,研制用于清洁玻璃墙壁的自动化清洁机器人势在必行。In the prior art, the cleaning of glass walls relies on manual cleaning. Workers hang themselves outside high-rise buildings by hanging baskets or fresh-keeping ropes to clean glass walls. Working at heights is not only dangerous, but also has low cleaning efficiency; therefore , it is imperative to develop an automated cleaning robot for cleaning glass walls.
发明内容Contents of the invention
本发明实施例提供了一种墙壁清洁机器人控制方法及控制系统,以解决现有的人工清洗玻璃墙壁由于高空作业导致危险程度高、清洗效率低的技术问题,以机器代替人工清洗玻璃墙壁,从而实现玻璃墙壁清洁作业的自动化,同时提高清洗效率。The embodiment of the present invention provides a wall cleaning robot control method and control system to solve the existing technical problems of high risk and low cleaning efficiency caused by manual cleaning of glass walls due to high-altitude operations, and replace manual cleaning of glass walls with machines, thereby Automate glass wall cleaning operations while increasing cleaning efficiency.
为了解决上述技术问题,本发明一方面提供了一种墙壁清洁机器人控制方法,所述墙壁清洁机器人包括控制器和分别与所述控制器电连接的气泵、清水抽水泵、驱动电机、X轴气缸以及Y轴气缸,所述控制方法包括步骤:In order to solve the above technical problems, the present invention provides a method for controlling a wall cleaning robot. The wall cleaning robot includes a controller and an air pump electrically connected to the controller, a clear water pump, a drive motor, and an X-axis cylinder. As well as the Y-axis cylinder, the control method includes the steps of:
S1、控制用于提供动力来源的气泵工作;S1. Control the work of the air pump used to provide the power source;
S2、检测墙壁清洁机器人是否处于清洁区域,若是,则启动清洁模式;S2. Detect whether the wall cleaning robot is in the cleaning area, and if so, start the cleaning mode;
S3、当清洁模式运行时,控制X轴气缸上的吸盘和Y轴气缸上的吸盘吸附在墙壁表面上,使得墙壁清洁机器人固定在墙壁上;S3. When the cleaning mode is running, control the suction cup on the X-axis cylinder and the suction cup on the Y-axis cylinder to be adsorbed on the wall surface, so that the wall cleaning robot is fixed on the wall;
S4、在检测到墙壁清洁机器人固定在墙壁之后,控制清水抽水泵和驱动电机工作,将清水集水箱的水抽出至用于清洗墙壁表面的清洁板,通过驱动电机驱动清洁板上的滚刷转动并在清水的辅助下清洗墙壁表面;S4. After detecting that the wall cleaning robot is fixed on the wall, control the clean water pump and drive motor to work, pump the water from the clean water collection tank to the cleaning plate used to clean the wall surface, and drive the roller brush on the cleaning plate to rotate through the drive motor And clean the wall surface with the help of clean water;
S5、检测墙壁清洁机器人是否关闭清洁模式,若是,则控制清水抽水泵和驱动电机停止工作,并启动攀爬模式;S5. Detect whether the cleaning mode of the wall cleaning robot is turned off, if so, control the clean water pump and the drive motor to stop working, and start the climbing mode;
S6、当攀爬模式运行时,控制X轴气缸进行X轴方向的移动和/或控制Y轴气缸进行Y轴方向的移动,以使所述墙壁清洁机器人攀爬至下一个清洁区域;S6. When the climbing mode is running, control the X-axis cylinder to move in the X-axis direction and/or control the Y-axis cylinder to move in the Y-axis direction, so that the wall cleaning robot climbs to the next cleaning area;
S7、检测墙壁清洁机器人是否攀爬至下一个清洁区域,若是,则启动清洁模式。S7. Detect whether the wall cleaning robot has climbed to the next cleaning area, and if so, start the cleaning mode.
作为优选方案,所述步骤S6、攀爬模式运行时,控制X轴气缸进行X轴方向的移动和/或控制Y轴气缸进行Y轴方向的移动以使所述墙壁清洁机器人攀爬至下一个清洁区域具体包括:As a preferred solution, when the step S6 is running in the climbing mode, control the X-axis cylinder to move in the X-axis direction and/or control the Y-axis cylinder to move in the Y-axis direction so that the wall cleaning robot can climb to the next The cleaning area specifically includes:
S61、攀爬模式运行时,判断墙壁清洁机器人是否往X轴方向运动或Y轴方向运动;S61. When the climbing mode is running, it is judged whether the wall cleaning robot moves in the direction of the X axis or the direction of the Y axis;
S62、当判断墙壁清洁机器人往X轴方向运动时,控制X轴气缸上的吸盘通入空气,控制X轴气缸往X轴的正/反方向运动;并且,S62. When it is judged that the wall cleaning robot is moving in the X-axis direction, control the suction cup on the X-axis cylinder to feed air, and control the X-axis cylinder to move in the positive/reverse direction of the X-axis; and,
在X轴气缸往X轴的正/反方向运动之后,通过X轴气缸上的吸盘吸附在墙壁表面上,同时释放Y轴气缸上的吸盘,控制X轴气缸回到原来的位置,以使墙壁清洁机器人往X轴的正/反方向运动;After the X-axis cylinder moves in the positive/reverse direction of the X-axis, the suction cup on the X-axis cylinder is adsorbed on the surface of the wall, and at the same time the suction cup on the Y-axis cylinder is released to control the X-axis cylinder to return to its original position, so that the wall The cleaning robot moves in the positive/reverse direction of the X axis;
S63、当判断墙壁清洁机器人往Y轴方向运动时,控制Y轴气缸上的吸盘通入空气,控制Y轴气缸往Y轴的正/反方向运动;并且,S63. When it is judged that the wall cleaning robot is moving in the Y-axis direction, control the suction cup on the Y-axis cylinder to feed air, and control the Y-axis cylinder to move in the positive/reverse direction of the Y-axis; and,
在Y轴气缸往Y轴的正/反方向运动之后,通过Y轴气缸上的吸盘吸附在墙壁表面上,同时释放X轴气缸上的吸盘,控制Y轴气缸回到原来的位置,以使墙壁清洁机器人往Y轴的正/反方向运动。After the Y-axis cylinder moves in the positive/reverse direction of the Y-axis, the suction cup on the Y-axis cylinder is adsorbed on the surface of the wall, and at the same time the suction cup on the X-axis cylinder is released to control the Y-axis cylinder to return to its original position, so that the wall The cleaning robot moves in the positive/reverse direction of the Y axis.
作为优选方案,所述墙壁清洁机器人控制系统还包括分别与控制器电连接的第一电磁阀、第一方向电磁阀、第二电磁阀、第二方向电磁阀,所述气泵、所述第一电磁阀、所述第一方向电磁阀依次通过管路连接在X轴气缸的进气端上,所述气泵、所述第二电磁阀、所述第二方向电磁阀依次通过管路连接在Y轴气缸的进气端上;As a preferred solution, the wall cleaning robot control system also includes a first solenoid valve, a first direction solenoid valve, a second solenoid valve, a second direction solenoid valve electrically connected to the controller, the air pump, the first The solenoid valve and the first direction solenoid valve are connected to the intake end of the X-axis cylinder through pipelines in turn, and the air pump, the second solenoid valve and the second direction solenoid valve are connected to the Y axis through pipelines in turn. On the intake end of the shaft cylinder;
则所述步骤S62具体为:Then the step S62 is specifically:
当判断墙壁清洁机器人往X轴方向运动时,控制X轴气缸上的吸盘通入空气,通过所述第一电磁阀通电、所述第一方向电磁阀通电并由所述第一方向电磁阀选择X轴气缸往X轴的正/反方向进行运动;并且,When it is judged that the wall cleaning robot is moving in the X-axis direction, the suction cup on the X-axis cylinder is controlled to feed air, the first electromagnetic valve is energized, the first directional electromagnetic valve is energized and selected by the first directional electromagnetic valve The X-axis cylinder moves in the positive/reverse direction of the X-axis; and,
在X轴气缸往X轴的正/反方向运动之后,通过X轴气缸上的吸盘吸附在墙壁表面上,同时释放Y轴气缸上的吸盘,通过所述第一方向电磁阀带动X轴气缸回到原来的位置,以使墙壁清洁机器人往X轴的正/反方向运动;After the X-axis cylinder moves to the positive/reverse direction of the X-axis, the suction cup on the X-axis cylinder is adsorbed on the wall surface, and the suction cup on the Y-axis cylinder is released at the same time, and the X-axis cylinder is driven back through the first direction solenoid valve. Go to the original position to make the wall cleaning robot move in the positive/reverse direction of the X axis;
则所述步骤S63具体为:Then the step S63 is specifically:
当判断墙壁清洁机器人往Y轴方向运动时,控制Y轴气缸上的吸盘通入空气,通过所述第二电磁阀通电、所述第二方向电磁阀通电并由所述第二方向电磁阀选择Y轴气缸往Y轴的正/反方向进行运动;并且,When it is judged that the wall cleaning robot is moving in the Y-axis direction, the sucker on the Y-axis cylinder is controlled to feed in the air, the second electromagnetic valve is energized, the second direction electromagnetic valve is energized and selected by the second direction electromagnetic valve The Y-axis cylinder moves in the positive/reverse direction of the Y-axis; and,
在Y轴气缸往Y轴的正/反方向运动之后,通过Y轴气缸上的吸盘吸附在墙壁表面上,同时释放X轴气缸上的吸盘,通过所述第二方向电磁阀带动Y轴气缸回到原来的位置,以使墙壁清洁机器人往Y轴的正/反方向运动。After the Y-axis cylinder moves in the positive/reverse direction of the Y-axis, the suction cup on the Y-axis cylinder is adsorbed on the wall surface, and at the same time the suction cup on the X-axis cylinder is released, and the Y-axis cylinder is driven back by the second direction solenoid valve. to the original position, so that the wall cleaning robot moves in the positive/reverse direction of the Y axis.
作为优选方案,所述墙壁清洁机器人还包括分别与所述控制器电连接的第三电磁阀、第四电磁阀、第一真空发生器、第二真空发生器、第一气路电磁阀、第二气路电磁阀;所述第三电磁阀、所述第一真空发生器、所述第一气路电磁阀通过管路连接在所述Y轴气缸上的吸盘上,所述第四电磁阀、所述第二真空发生器、所述第二气路电磁阀通过管路连接在所述X轴气缸上的吸盘上;As a preferred solution, the wall cleaning robot also includes a third solenoid valve, a fourth solenoid valve, a first vacuum generator, a second vacuum generator, a first air circuit solenoid valve, a Two air circuit solenoid valves; the third solenoid valve, the first vacuum generator, and the first air circuit solenoid valve are connected to the suction cup on the Y-axis cylinder through pipelines, and the fourth solenoid valve . The second vacuum generator and the second air circuit solenoid valve are connected to the suction cup on the X-axis cylinder through pipelines;
所述步骤S3、当清洁模式运行时,控制X轴气缸上的吸盘和Y轴气缸上的吸盘吸附在墙壁表面上,使得墙壁清洁机器人固定在墙壁上具体为:The step S3, when the cleaning mode is running, control the suction cup on the X-axis cylinder and the suction cup on the Y-axis cylinder to be adsorbed on the wall surface, so that the wall cleaning robot is fixed on the wall. Specifically:
当清洁模式运行时,控制所述第四电磁阀、所述第二气路电磁阀断电,以使所述第二真空发生器抽去所述X轴气缸上的吸盘内的空气,从而使得所述墙壁清洁机器人通过所述X轴气缸上的吸盘吸附在墙壁表面上;及When the cleaning mode is running, control the fourth solenoid valve and the second air circuit solenoid valve to de-energize, so that the second vacuum generator can remove the air in the suction cup on the X-axis cylinder, so that The wall cleaning robot is adsorbed on the wall surface through the suction cup on the X-axis cylinder; and
控制所述第三电磁阀、所述第一气路电磁阀断电,以使所述第一真空发生器抽去所述Y轴气缸上的吸盘内的空气,从而使得所述墙壁清洁机器人通过所述Y 轴气缸上的吸盘吸附在墙壁表面上。Controlling the third solenoid valve and the first air path solenoid valve to de-energize, so that the first vacuum generator sucks the air in the suction cup on the Y-axis cylinder, so that the wall cleaning robot can pass through The suction cup on the Y-axis cylinder is adsorbed on the wall surface.
作为优选方案,所述步骤S62具体为:As a preferred solution, the step S62 is specifically:
当判断墙壁清洁机器人往X轴方向运动时,控制所述第四电磁阀、所述第二气路电磁阀通电以释放X轴气缸上的吸盘,控制X轴气缸往X轴的正/反方向运动;并且,When it is judged that the wall cleaning robot is moving in the direction of the X-axis, control the fourth solenoid valve and the second air circuit solenoid valve to be energized to release the suction cup on the X-axis cylinder, and control the X-axis cylinder to move in the positive/reverse direction of the X-axis exercise; and,
在X轴气缸往X轴的正/反方向运动之后,通过所述第四电磁阀、所述第二气路电磁阀断电,以使所述第二真空发生器抽去所述X轴气缸上的吸盘内的空气,从而使得所述墙壁清洁机器人通过X轴气缸上的吸盘吸附在墙壁表面上,同时,通过所述第三电磁阀、所述第一气路电磁阀通电以释放Y轴气缸上的吸盘,控制X轴气缸回到原来的位置,以使墙壁清洁机器人往X轴的正/反方向运动;After the X-axis cylinder moves to the positive/reverse direction of the X-axis, the fourth solenoid valve and the second air circuit solenoid valve are de-energized, so that the second vacuum generator can remove the X-axis cylinder The air in the suction cup on the upper surface, so that the wall cleaning robot is adsorbed on the wall surface through the suction cup on the X-axis cylinder, and at the same time, the third solenoid valve and the first air circuit solenoid valve are energized to release the Y-axis The suction cup on the cylinder controls the X-axis cylinder to return to its original position, so that the wall cleaning robot can move in the positive/reverse direction of the X-axis;
所述步骤S63具体为:The step S63 is specifically:
当判断墙壁清洁机器人往Y轴方向运动时,通过所述第三电磁阀、所述第一气路电磁阀通电以控制Y轴气缸上的吸盘通入空气,控制Y轴气缸往Y轴的正/ 反方向运动;并且,When it is judged that the wall cleaning robot is moving in the direction of the Y axis, the third electromagnetic valve and the first air circuit electromagnetic valve are energized to control the sucker on the Y axis cylinder to pass into the air, and the positive direction of the Y axis cylinder to the Y axis is controlled. / movement in the opposite direction; and,
在Y轴气缸往Y轴的正/反方向运动之后,通过所述第三电磁阀、所述第一气路电磁阀断电,以使所述第一真空发生器抽去所述Y轴气缸上的吸盘内的空气,从而使得所述墙壁清洁机器人通过Y轴气缸上的吸盘吸附在墙壁表面上,同时,通过所述第一电磁阀、所述第二气路电磁阀通电以释放X轴气缸上的吸盘,控制Y轴气缸回到原来的位置,以使墙壁清洁机器人往Y轴的正/反方向运动。After the Y-axis cylinder moves to the positive/reverse direction of the Y-axis, the third solenoid valve and the first air circuit solenoid valve are de-energized so that the first vacuum generator can draw the Y-axis cylinder The air in the suction cup on the upper surface makes the wall cleaning robot adsorb on the wall surface through the suction cup on the Y-axis cylinder. At the same time, the first solenoid valve and the second air circuit solenoid valve are energized to release the X-axis The suction cup on the cylinder controls the Y-axis cylinder to return to its original position, so that the wall cleaning robot can move in the positive/reverse direction of the Y-axis.
作为优选方案,所述墙壁清洁机器人包括与所述控制器电连接的树莓派摄像头;所述步骤S2、检测墙壁清洁机器人是否处于清洁区域,若是,则启动清洁模式具体为:As a preferred solution, the wall cleaning robot includes a Raspberry Pi camera electrically connected to the controller; the step S2, detecting whether the wall cleaning robot is in the cleaning area, if so, starting the cleaning mode is specifically:
所述树莓派摄像头识别所述墙壁清洁机器人攀爬的区域,并将信号发送到所述控制器,所述控制器处理信号并进行清洁区域的判断;The raspberry pie camera recognizes the area where the wall cleaning robot climbs, and sends a signal to the controller, and the controller processes the signal and judges the cleaning area;
当判断所述墙壁清洁机器人处于非清洁区域时,则启动攀爬模式,控制X轴气缸进行移动和/或控制Y轴气缸进行移动以使所述墙壁清洁机器人攀爬至下一个清洁区域;When it is judged that the wall cleaning robot is in a non-cleaning area, the climbing mode is started, and the X-axis cylinder is controlled to move and/or the Y-axis cylinder is controlled to move so that the wall cleaning robot climbs to the next cleaning area;
当判断所述墙壁清洁机器人处于清洁区域时,则启动清洁模式。When it is judged that the wall cleaning robot is in the cleaning area, the cleaning mode is started.
作为优选方案,所述墙壁清洁机器人还包括步进电机、同步带,所述步进电机的输出轴与所述同步带连接,所述同步带与所述清洁板固定连接,所述步进电机与所述控制器连接;所述步骤S4具体为:As a preferred solution, the wall cleaning robot also includes a stepping motor and a synchronous belt, the output shaft of the stepping motor is connected to the synchronous belt, the synchronous belt is fixedly connected to the cleaning plate, and the stepping motor Connect with the controller; the step S4 is specifically:
在检测到墙壁清洁机器人固定在墙壁之后,控制清水抽水泵工作,将清水集水箱的水抽出至用于清洗墙壁表面的清洁板;并且After detecting that the wall cleaning robot is fixed on the wall, the clean water pump is controlled to work, and the water in the clean water collection tank is pumped out to the cleaning plate for cleaning the wall surface; and
控制步进电机工作,以使步进电机驱动同步带,从而带动清洁板往复移动;及Control the operation of the stepping motor so that the stepping motor drives the timing belt, thereby driving the cleaning plate to reciprocate; and
控制驱动电机工作,通过驱动电机驱动清洁板上的滚刷转动并在清水的辅助下清洗墙壁表面。The drive motor is controlled to work, and the roller brush on the cleaning plate is driven to rotate by the drive motor, and the wall surface is cleaned with the aid of clear water.
作为优选方案,所述墙壁清洁机器人还包括污水抽水泵、过滤器、用于收集清洁墙壁表面后的污水的污水集水箱,所述所述无水抽水泵与所述控制器电连接;所述步骤S4具体为:As a preferred solution, the wall cleaning robot also includes a sewage water pump, a filter, and a sewage water collection tank for collecting sewage after cleaning the wall surface, and the anhydrous water pump is electrically connected to the controller; Step S4 is specifically:
在检测到墙壁清洁机器人固定在墙壁之后,控制清水抽水泵和驱动电机工作,将清水集水箱的水抽出至用于清洗墙壁表面的清洁板,通过驱动电机驱动清洁板上的滚刷转动并在清水的辅助下清洗墙壁表面;并且,After detecting that the wall cleaning robot is fixed on the wall, control the clean water pump and drive motor to work, pump the water from the clean water collection tank to the cleaning plate used to clean the wall surface, and drive the roller brush on the cleaning plate to rotate through the drive motor. cleaning of wall surfaces with the aid of fresh water; and,
控制所述污水抽水泵将污水集水箱的水抽出并通过过滤器输送至清水集水箱中,从而形成清洁水循环。The sewage water pump is controlled to extract water from the sewage water collection tank and deliver it to the clean water collection tank through the filter, thereby forming a clean water cycle.
为了解决相同的技术问题,本发明另一方面提供了一种墙壁清洁机器人控制系统,所述墙壁清洁机器人包括壳体,所述壳体上设有控制器和分别与所述控制器电连接的气泵、清水抽水泵、驱动电机、X轴气缸以及Y轴气缸,所述X轴气缸包括X轴滑块和X轴移动杆,所述X轴移动杆的两端上设有吸盘,且所述 X轴滑块可滑动地连接在所述X轴移动杆上;所述Y轴气缸包括Y轴滑块和Y 轴移动杆,所述Y轴移动杆的两端上设有吸盘,且所述Y轴滑块可滑动地连接在所述Y轴移动杆上;所述控制器用于In order to solve the same technical problem, another aspect of the present invention provides a wall cleaning robot control system, the wall cleaning robot includes a housing, the housing is provided with a controller and respectively electrically connected to the controller Air pump, clean water pump, driving motor, X-axis cylinder and Y-axis cylinder, the X-axis cylinder includes an X-axis slider and an X-axis moving rod, suction cups are arranged on both ends of the X-axis moving rod, and the The X-axis slider is slidably connected to the X-axis moving rod; the Y-axis cylinder includes a Y-axis slider and a Y-axis moving rod, and suction cups are arranged on both ends of the Y-axis moving rod, and the The Y-axis slider is slidably connected on the Y-axis moving rod; the controller is used for
控制用于提供动力来源的气泵工作;Control the operation of the air pump used to provide the power source;
检测墙壁清洁机器人是否处于清洁区域,若是,则启动清洁模式;Detect whether the wall cleaning robot is in the cleaning area, and if so, start the cleaning mode;
当清洁模式运行时,控制X轴气缸上的吸盘和Y轴气缸上的吸盘吸附在墙壁表面上,使得墙壁清洁机器人固定在墙壁上;When the cleaning mode is running, control the suction cup on the X-axis cylinder and the suction cup on the Y-axis cylinder to adsorb on the wall surface, so that the wall cleaning robot is fixed on the wall;
在检测到墙壁清洁机器人固定在墙壁之后,控制清水抽水泵和驱动电机工作,将清水集水箱的水抽出至用于清洗墙壁表面的清洁板,通过驱动电机驱动清洁板上的滚刷转动并在清水的辅助下清洗墙壁表面;After detecting that the wall cleaning robot is fixed on the wall, control the clean water pump and drive motor to work, pump the water from the clean water collection tank to the cleaning plate used to clean the wall surface, and drive the roller brush on the cleaning plate to rotate through the drive motor. Clean the wall surface with the aid of clean water;
检测墙壁清洁机器人是否关闭清洁模式,若是,则控制清水抽水泵和驱动电机停止工作,并启动攀爬模式;Detect whether the cleaning mode of the wall cleaning robot is off, if so, control the fresh water pump and drive motor to stop working, and start the climbing mode;
当攀爬模式运行时,控制X轴气缸进行X轴方向的移动和/或控制Y轴气缸进行Y轴方向的移动以使所述墙壁清洁机器人攀爬至下一个清洁区域;When the climbing mode is running, control the X-axis cylinder to move in the X-axis direction and/or control the Y-axis cylinder to move in the Y-axis direction so that the wall cleaning robot climbs to the next cleaning area;
检测墙壁清洁机器人是否攀爬至下一个清洁区域,若是,则启动清洁模式。Detect whether the wall cleaning robot has climbed to the next cleaning area, and if so, start the cleaning mode.
作为优选方案,所述控制器还用于As a preferred solution, the controller is also used for
攀爬模式运行时,判断墙壁清洁机器人是否往X轴方向运动或Y轴方向运动;When the climbing mode is running, judge whether the wall cleaning robot is moving in the X-axis direction or the Y-axis direction;
当判断墙壁清洁机器人往X轴方向运动时,控制X轴气缸上的吸盘通入空气,控制X轴气缸往X轴的正/反方向运动;并且,When it is judged that the wall cleaning robot is moving in the X-axis direction, control the suction cup on the X-axis cylinder to feed air, and control the X-axis cylinder to move in the positive/reverse direction of the X-axis; and,
在X轴气缸往X轴的正/反方向运动之后,通过X轴气缸上的吸盘吸附在墙壁表面上,同时释放Y轴气缸上的吸盘,控制X轴气缸回到原来的位置,以使墙壁清洁机器人往X轴的正/反方向运动;After the X-axis cylinder moves in the positive/reverse direction of the X-axis, the suction cup on the X-axis cylinder is adsorbed on the surface of the wall, and at the same time the suction cup on the Y-axis cylinder is released to control the X-axis cylinder to return to its original position, so that the wall The cleaning robot moves in the positive/reverse direction of the X axis;
当判断墙壁清洁机器人往Y轴方向运动时,控制Y轴气缸上的吸盘通入空气,控制Y轴气缸往Y轴的正/反方向运动;并且,When it is judged that the wall cleaning robot is moving in the Y-axis direction, control the suction cup on the Y-axis cylinder to feed air, and control the Y-axis cylinder to move in the positive/reverse direction of the Y-axis; and,
在Y轴气缸往Y轴的正/反方向运动之后,通过Y轴气缸上的吸盘吸附在墙壁表面上,同时释放X轴气缸上的吸盘,控制Y轴气缸回到原来的位置,以使墙壁清洁机器人往Y轴的正/反方向运动。After the Y-axis cylinder moves in the positive/reverse direction of the Y-axis, the suction cup on the Y-axis cylinder is adsorbed on the surface of the wall, and at the same time the suction cup on the X-axis cylinder is released to control the Y-axis cylinder to return to its original position, so that the wall The cleaning robot moves in the positive/reverse direction of the Y axis.
本发明具有如下有益效果:The present invention has following beneficial effects:
1、通过X轴气缸和Y轴气缸在吸盘的辅助下进行交替运动,从而使得墙壁清洁机器人在二维平面的墙壁表面上进行攀爬运动,并保证了墙壁清洁机器人在运动过程中的稳定性和可靠性;1. Through the alternate movement of the X-axis cylinder and the Y-axis cylinder with the assistance of the suction cup, the wall cleaning robot can climb on the two-dimensional plane wall surface and ensure the stability of the wall cleaning robot during the movement process and reliability;
2、当墙壁清洁机器人位于清洁区域时,滚刷在驱动电机的驱动下高速转动,并在清水的辅助下对墙壁表面进行清洗,从而提高清洗效率;2. When the wall cleaning robot is located in the cleaning area, the roller brush rotates at high speed under the drive of the drive motor, and cleans the wall surface with the help of clean water, thereby improving the cleaning efficiency;
3、墙壁清洁机器人在一个清洁区域完成清洁作业后,启动攀爬模式,使得墙壁清洁机器人攀爬至需要清洁的墙壁表面上;当攀爬至下一个清洁区域后,通过X轴气缸上的吸盘和Y轴气缸上的吸盘重新固定并处于在下一个清洁区域,启动清洁模式,以继续进行墙壁表面的清洁作业;3. After the wall cleaning robot completes the cleaning operation in a cleaning area, start the climbing mode, so that the wall cleaning robot climbs to the wall surface to be cleaned; when climbing to the next cleaning area, it passes through the suction cup on the X-axis cylinder And the suction cup on the Y-axis cylinder is fixed again and is in the next cleaning area, and the cleaning mode is started to continue the cleaning of the wall surface;
4、气泵不仅为X轴气缸上的吸盘和Y轴气缸上的吸盘提供吸力,还为X轴气缸和Y轴气缸的移动提供动力,以使墙壁清洁机器人能够在墙壁表面上进行运动;通过气泵、X轴气缸、Y轴气缸以及吸盘的配合工作,简化了墙壁清洁机器人的结构,降低墙壁清洁机器人的操作难度;4. The air pump not only provides suction for the suction cup on the X-axis cylinder and the suction cup on the Y-axis cylinder, but also provides power for the movement of the X-axis cylinder and the Y-axis cylinder, so that the wall cleaning robot can move on the wall surface; through the air pump , X-axis cylinder, Y-axis cylinder and the suction cup work together to simplify the structure of the wall cleaning robot and reduce the operation difficulty of the wall cleaning robot;
5、X轴气缸使得墙壁清洁机器人实现X轴方向直线运动,Y轴气缸使得墙壁清洁机器人实现Y轴方向的直线运动,从而通过两个方向直线运动合成下使得墙壁清洁机器人能够在二维平面的墙壁上进行自由运动。5. The X-axis cylinder enables the wall cleaning robot to achieve linear motion in the X-axis direction, and the Y-axis cylinder enables the wall cleaning robot to achieve linear motion in the Y-axis direction, so that the wall cleaning robot can move in a two-dimensional plane through the synthesis of linear motion in two directions. Free movement on the wall.
附图说明Description of drawings
图1是本发明提供的墙壁清洁机器人控制方法的第一实施例的流程示意图;Fig. 1 is a schematic flow chart of the first embodiment of the wall cleaning robot control method provided by the present invention;
图2是本发明提供的墙壁清洁机器人控制方法的第二实施例的流程示意图;Fig. 2 is a schematic flow chart of the second embodiment of the method for controlling a wall cleaning robot provided by the present invention;
图3是本发明提供的墙壁清洁机器人控制方法的第三实施例的流程示意图;Fig. 3 is a schematic flow chart of a third embodiment of the method for controlling a wall cleaning robot provided by the present invention;
图4是本发明提供的墙壁清洁机器人控制装置的第一实施例的结构示意图;Fig. 4 is a schematic structural view of the first embodiment of the wall cleaning robot control device provided by the present invention;
图5是本发明提供的墙壁清洁机器人控制装置的第一实施例的电气原理图。Fig. 5 is an electrical schematic diagram of the first embodiment of the wall cleaning robot control device provided by the present invention.
具体实施方式Detailed ways
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。The following will clearly and completely describe the technical solutions in the embodiments of the present invention with reference to the accompanying drawings in the embodiments of the present invention. Obviously, the described embodiments are only some, not all, embodiments of the present invention. Based on the embodiments of the present invention, all other embodiments obtained by persons of ordinary skill in the art without creative efforts fall within the protection scope of the present invention.
参见图1至图5,本发明优选实施例提供了一种墙壁清洁机器人控制方法,所述墙壁清洁机器人包括控制器和分别与所述控制器电连接的气泵100、清水抽水泵20、驱动电机、X轴气缸109以及Y轴气缸110,所述控制方法包括步骤:1 to 5, a preferred embodiment of the present invention provides a method for controlling a wall cleaning robot, the wall cleaning robot includes a controller and an air pump 100, a clear water pump 20, and a driving motor electrically connected to the controller, respectively. , X-axis cylinder 109 and Y-axis cylinder 110, the control method includes steps:
S1、控制用于提供动力来源的气泵100工作;S1. Control the operation of the air pump 100 for providing the power source;
S2、检测墙壁清洁机器人是否处于清洁区域,若是,则启动清洁模式;S2. Detect whether the wall cleaning robot is in the cleaning area, and if so, start the cleaning mode;
S3、当清洁模式运行时,控制X轴气缸上的吸盘a和Y轴气缸上的吸盘b 吸附在墙壁表面上,使得墙壁清洁机器人固定在墙壁上;S3. When the cleaning mode is running, control the suction cup a on the X-axis cylinder and the suction cup b on the Y-axis cylinder to adsorb on the wall surface, so that the wall cleaning robot is fixed on the wall;
S4、在检测到墙壁清洁机器人固定在墙壁之后,控制清水抽水泵20和驱动电机工作,将清水集水箱21的水抽出至用于清洗墙壁表面的清洁板22,通过驱动电机驱动清洁板22上的滚刷222转动并在清水的辅助下清洗墙壁表面;S4, after detecting that the wall cleaning robot is fixed on the wall, control the clean water pump 20 and the driving motor to work, pump the water from the clean water collection tank 21 to the cleaning plate 22 for cleaning the wall surface, and drive the cleaning plate 22 through the driving motor The rolling brush 222 rotates and cleans the wall surface with the assistance of clear water;
S5、检测墙壁清洁机器人是否关闭清洁模式,若是,则控制清水抽水泵20 和驱动电机停止工作,并启动攀爬模式;S5. Detect whether the cleaning mode of the wall cleaning robot is closed, if so, control the clean water pump 20 and the driving motor to stop working, and start the climbing mode;
S6、当攀爬模式运行时,控制X轴气缸109进行X轴方向的移动和/或控制 Y轴气缸110进行Y轴方向的移动,以使所述墙壁清洁机器人攀爬至下一个清洁区域;S6. When the climbing mode is running, control the X-axis cylinder 109 to move in the X-axis direction and/or control the Y-axis cylinder 110 to move in the Y-axis direction, so that the wall cleaning robot climbs to the next cleaning area;
S7、检测墙壁清洁机器人是否攀爬至下一个清洁区域,若是,则启动清洁模式。S7. Detect whether the wall cleaning robot has climbed to the next cleaning area, and if so, start the cleaning mode.
在本发明实施例中,通过X轴气缸109和Y轴气缸110在吸盘的辅助下进行交替运动,从而使得墙壁清洁机器人在二维平面的墙壁表面上进行攀爬运动,并保证了墙壁清洁机器人在运动过程中的稳定性和可靠性;当墙壁清洁机器人位于清洁区域时,滚刷222在驱动电机的驱动下高速转动,并在清水的辅助下对墙壁表面进行清洗,从而提高清洗效率;墙壁清洁机器人在一个清洁区域完成清洁作业后,启动攀爬模式,使得墙壁清洁机器人攀爬至需要清洁的墙壁表面上;当攀爬至下一个清洁区域后,通过X轴气缸上的吸盘a和Y轴气缸上的吸盘b重新固定并处于在下一个清洁区域,启动清洁模式,以继续进行墙壁表面的清洁作业;气泵100不仅为X轴气缸上的吸盘a和Y轴气缸上的吸盘b提供吸力,还为X轴气缸109和Y轴气缸110的移动提供动力,以使墙壁清洁机器人能够在墙壁表面上进行运动;通过气泵100、X轴气缸109、Y轴气缸110以及吸盘的配合工作,简化了墙壁清洁机器人的结构,降低墙壁清洁机器人的操作难度;由于X轴气缸109使得墙壁清洁机器人实现X轴方向直线运动,Y轴气缸110使得墙壁清洁机器人实现Y轴方向的直线运动,从而通过两个方向直线运动合成下使得墙壁清洁机器人能够在二维平面的墙壁上进行自由运动。In the embodiment of the present invention, the X-axis cylinder 109 and the Y-axis cylinder 110 are alternately moved with the assistance of the suction cup, so that the wall cleaning robot can climb on the wall surface of the two-dimensional plane, and ensure that the wall cleaning robot Stability and reliability during movement; when the wall cleaning robot is located in the cleaning area, the roller brush 222 rotates at high speed under the drive of the drive motor, and cleans the wall surface with the assistance of clear water, thereby improving cleaning efficiency; After the cleaning robot completes the cleaning work in a cleaning area, start the climbing mode, so that the wall cleaning robot climbs to the wall surface to be cleaned; when climbing to the next cleaning area, it passes through the suction cup a and Y on the X-axis cylinder The suction cup b on the axis cylinder is fixed again and is in the next cleaning area, and the cleaning mode is started to continue the cleaning operation on the wall surface; the air pump 100 not only provides suction for the suction cup a on the X-axis cylinder and the suction cup b on the Y-axis cylinder, It also provides power for the movement of the X-axis cylinder 109 and the Y-axis cylinder 110, so that the wall cleaning robot can move on the wall surface; through the cooperation of the air pump 100, the X-axis cylinder 109, the Y-axis cylinder 110 and the suction cup, it is simplified. The structure of the wall cleaning robot reduces the difficulty of operation of the wall cleaning robot; since the X-axis cylinder 109 enables the wall cleaning robot to achieve linear motion in the X-axis direction, and the Y-axis cylinder 110 enables the wall cleaning robot to achieve linear motion in the Y-axis direction, thus through two The combination of direction and linear motion enables the wall cleaning robot to move freely on the two-dimensional wall.
在本实施例中,应当说明的是,所述控制器为stm32单片机,stm32单片机具有输出高低电平的能力,将控制信号发送到所述攀爬装置的电磁阀,其中stm32 单片机可以输出0到3.3V,电磁阀的工作电压是12V,从而实现低电压控制高电压的过程。由于树莓派摄像头的传输数据快,传输数据量多,可用raspberry pi 3b+ 处理速度以达到700MHZ,此外,清洁机器人上设有舵机控制云台支架,以使所述摄像头可随意转动,从而实时采集数据并将数据传输到所述处理器进行数据处理。In this embodiment, it should be noted that the controller is a stm32 single-chip microcomputer, and the stm32 single-chip microcomputer has the ability to output high and low levels, and sends the control signal to the solenoid valve of the climbing device, wherein the stm32 single-chip microcomputer can output 0 to 3.3V, the operating voltage of the solenoid valve is 12V, so as to realize the process of low voltage control high voltage. Due to the fast data transmission of the Raspberry Pi camera and the large amount of transmitted data, the raspberry pi 3b+ processing speed can reach 700MHZ. In addition, the cleaning robot is equipped with a steering gear to control the pan-tilt bracket, so that the camera can be rotated at will, so that real-time Data is collected and transmitted to the processor for data processing.
此外,所述墙壁清洁机器人上还设有避障传感器,所述避障传感器用于检测障碍物,并将检测信息发送到所述控制器进行处理,从而实现墙壁清洁机器人在攀爬时的自动避障以自动绕开障碍物。并且所述控制器能够进行通讯,能够将信息从下位机上传送到上位机,更能方便的进行人机交互,更能了解机器人的状态。In addition, the wall cleaning robot is also provided with an obstacle avoidance sensor, the obstacle avoidance sensor is used to detect obstacles, and send the detection information to the controller for processing, thereby realizing the automatic movement of the wall cleaning robot when climbing. Obstacle Avoidance to automatically navigate around obstacles. Moreover, the controller is capable of communication, and can transmit information from the lower computer to the upper computer, so that human-computer interaction can be performed more conveniently, and the status of the robot can be better understood.
参见图1至图5,在本发明实施例中,所述步骤S6、攀爬模式运行时,控制 X轴气缸109进行X轴方向的移动和/或控制Y轴气缸110进行Y轴方向的移动以使所述墙壁清洁机器人攀爬至下一个清洁区域具体包括:Referring to Figures 1 to 5, in the embodiment of the present invention, in step S6, when the climbing mode is running, control the X-axis cylinder 109 to move in the X-axis direction and/or control the Y-axis cylinder 110 to move in the Y-axis direction Making the wall cleaning robot climb to the next cleaning area specifically includes:
S61、攀爬模式运行时,判断墙壁清洁机器人是否往X轴方向运动或Y轴方向运动;S61. When the climbing mode is running, it is judged whether the wall cleaning robot moves in the direction of the X axis or the direction of the Y axis;
S62、当判断墙壁清洁机器人往X轴方向运动时,控制X轴气缸上的吸盘a 通入空气,控制X轴气缸109往X轴的正/反方向运动;并且,S62. When it is judged that the wall cleaning robot is moving in the X-axis direction, control the suction cup a on the X-axis cylinder to feed air, and control the X-axis cylinder 109 to move in the positive/reverse direction of the X-axis; and,
在X轴气缸109往X轴的正/反方向运动之后,通过X轴气缸上的吸盘a吸附在墙壁表面上,同时释放Y轴气缸上的吸盘b,控制X轴气缸109回到原来的位置,以使墙壁清洁机器人往X轴的正/反方向运动;After the X-axis cylinder 109 moves to the positive/reverse direction of the X-axis, the suction cup a on the X-axis cylinder is adsorbed on the wall surface, and the suction cup b on the Y-axis cylinder is released at the same time, and the X-axis cylinder 109 is controlled to return to the original position , so that the wall cleaning robot moves in the positive/reverse direction of the X axis;
S63、当判断墙壁清洁机器人往Y轴方向运动时,控制Y轴气缸上的吸盘b 通入空气,控制Y轴气缸110往Y轴的正/反方向运动;并且,S63. When it is judged that the wall cleaning robot is moving in the Y-axis direction, control the suction cup b on the Y-axis cylinder to feed air, and control the Y-axis cylinder 110 to move in the positive/reverse direction of the Y-axis; and,
在Y轴气缸110往Y轴的正/反方向运动之后,通过Y轴气缸上的吸盘b吸附在墙壁表面上,同时释放X轴气缸上的吸盘a,控制Y轴气缸110回到原来的位置,以使墙壁清洁机器人往Y轴的正/反方向运动。After the Y-axis cylinder 110 moves in the positive/reverse direction of the Y-axis, the suction cup b on the Y-axis cylinder is adsorbed on the wall surface, and at the same time the suction cup a on the X-axis cylinder is released to control the Y-axis cylinder 110 to return to its original position , so that the wall cleaning robot moves in the positive/reverse direction of the Y axis.
在本发明实施例中,应当说明的是,所述X轴气缸109和所述Y轴气缸110 均为无杆气缸,X轴气缸109的滑块和Y轴气缸110的滑块固定在一起并安装在墙壁清洁机器人的壳体内,无杆气缸的原理是:无杆气缸具有两个进气端,当无杆气缸的一端进气时,滑块向另一端滑动。X轴无杆气缸和Y轴无杆气缸在所述控制器的控制下进行交替运动,可变换为T字型和十字型,从而实现二维平面上的移动。In the embodiment of the present invention, it should be noted that both the X-axis cylinder 109 and the Y-axis cylinder 110 are rodless cylinders, and the slider of the X-axis cylinder 109 and the slider of the Y-axis cylinder 110 are fixed together and Installed in the shell of the wall cleaning robot, the principle of the rodless cylinder is: the rodless cylinder has two intake ends, and when one end of the rodless cylinder receives air, the slider slides to the other end. The X-axis rodless cylinder and the Y-axis rodless cylinder move alternately under the control of the controller, which can be transformed into T-shaped and cross-shaped, thereby realizing movement on a two-dimensional plane.
参见图3至图5,在本发明实施例中,所述墙壁清洁机器人还包括分别与控制器电连接的第一电磁阀101、第一方向电磁阀105、第二电磁阀102、第二方向电磁阀106,所述气泵100、所述第一电磁阀101、所述第一方向电磁阀105依次通过管路连接在X轴气缸109的进气端上,所述气泵100、所述第二电磁阀102、所述第二方向电磁阀106依次通过管路连接在Y轴气缸110的进气端上;Referring to Fig. 3 to Fig. 5, in the embodiment of the present invention, the wall cleaning robot further includes a first solenoid valve 101, a first direction solenoid valve 105, a second solenoid valve 102, and a second direction solenoid valve electrically connected to the controller respectively. The solenoid valve 106, the air pump 100, the first solenoid valve 101, and the first direction solenoid valve 105 are sequentially connected to the intake end of the X-axis cylinder 109 through pipelines, and the air pump 100, the second The solenoid valve 102 and the second direction solenoid valve 106 are sequentially connected to the intake end of the Y-axis cylinder 110 through pipelines;
则所述步骤S62具体为:Then the step S62 is specifically:
当判断墙壁清洁机器人往X轴方向运动时,控制X轴气缸上的吸盘a通入空气,通过所述第一电磁阀101通电、所述第一方向电磁阀105通电并由所述第一方向电磁阀105选择X轴气缸109往X轴的正/反方向进行运动;并且,When it is judged that the wall cleaning robot is moving in the X-axis direction, the sucker a on the X-axis cylinder is controlled to feed air, the first electromagnetic valve 101 is energized, the first direction electromagnetic valve 105 is energized, and the first direction electromagnetic valve 105 is energized. The solenoid valve 105 selects the X-axis cylinder 109 to move in the positive/reverse direction of the X-axis; and,
在X轴气缸109往X轴的正/反方向运动之后,通过X轴气缸上的吸盘a吸附在墙壁表面上,同时释放Y轴气缸上的吸盘b,通过所述第一方向电磁阀105 带动X轴气缸109回到原来的位置,以使墙壁清洁机器人往X轴的正/反方向运动;After the X-axis cylinder 109 moves in the positive/reverse direction of the X-axis, the suction cup a on the X-axis cylinder is adsorbed on the wall surface, and the suction cup b on the Y-axis cylinder is released at the same time, driven by the first direction solenoid valve 105 The X-axis cylinder 109 returns to its original position, so that the wall cleaning robot moves in the positive/reverse direction of the X-axis;
则所述步骤S63具体为:Then the step S63 is specifically:
当判断墙壁清洁机器人往Y轴方向运动时,控制Y轴气缸上的吸盘b通入空气,通过所述第二电磁阀102通电、所述第二方向电磁阀106通电并由所述第二方向电磁阀106选择Y轴气缸110往Y轴的正/反方向进行运动;并且,When it is judged that the wall cleaning robot is moving in the Y-axis direction, the sucker b on the Y-axis cylinder is controlled to feed air, the second solenoid valve 102 is energized, the second direction solenoid valve 106 is energized, and the second direction The solenoid valve 106 selects the Y-axis cylinder 110 to move in the positive/reverse direction of the Y-axis; and,
在Y轴气缸110往Y轴的正/反方向运动之后,通过Y轴气缸上的吸盘b吸附在墙壁表面上,同时释放X轴气缸上的吸盘a,通过所述第二方向电磁阀106 带动Y轴气缸110回到原来的位置,以使墙壁清洁机器人往Y轴的正/反方向运动。After the Y-axis cylinder 110 moves in the positive/reverse direction of the Y-axis, the suction cup b on the Y-axis cylinder is adsorbed on the wall surface, and at the same time the suction cup a on the X-axis cylinder is released, and driven by the second direction solenoid valve 106 The Y-axis cylinder 110 returns to its original position, so that the wall cleaning robot can move in the positive/reverse direction of the Y-axis.
参见图3至图5,在本发明实施例中,所述墙壁清洁机器人还包括分别与所述控制器电连接的第三电磁阀103、第四电磁阀104、第一真空发生器111、第二真空发生器112、第一气路电磁阀117、第二气路电磁阀118;所述第三电磁阀 103、所述第一真空发生器111、所述第一气路电磁阀117通过管路连接在所述Y 轴气缸上的吸盘b上,所述第四电磁阀104、所述第二真空发生器112、所述第二气路电磁阀118通过管路连接在所述X轴气缸上的吸盘a上;Referring to Fig. 3 to Fig. 5, in the embodiment of the present invention, the wall cleaning robot further includes a third solenoid valve 103, a fourth solenoid valve 104, a first vacuum generator 111, a Two vacuum generators 112, the first gas path solenoid valve 117, and the second gas path solenoid valve 118; the third solenoid valve 103, the first vacuum generator 111, and the first gas path solenoid valve 117 are The pipeline is connected to the suction cup b on the Y-axis cylinder, and the fourth solenoid valve 104, the second vacuum generator 112, and the second air solenoid valve 118 are connected to the X-axis cylinder through pipelines. on the suction cup a;
所述步骤S3、当清洁模式运行时,控制X轴气缸上的吸盘a和Y轴气缸上的吸盘b吸附在墙壁表面上,使得墙壁清洁机器人固定在墙壁上具体为:The step S3, when the cleaning mode is running, control the suction cup a on the X-axis cylinder and the suction cup b on the Y-axis cylinder to adsorb on the wall surface, so that the wall cleaning robot is fixed on the wall. Specifically:
当清洁模式运行时,控制所述第四电磁阀104、所述第二气路电磁阀118断电,以使所述第二真空发生器112抽去所述X轴气缸上的吸盘a内的空气,从而使得所述墙壁清洁机器人通过所述X轴气缸上的吸盘a吸附在墙壁表面上;及When the cleaning mode is running, control the fourth solenoid valve 104 and the second air circuit solenoid valve 118 to cut off power, so that the second vacuum generator 112 can remove the vacuum in the suction cup a on the X-axis cylinder. air, so that the wall cleaning robot is adsorbed on the wall surface through the suction cup a on the X-axis cylinder; and
控制所述第三电磁阀103、所述第一气路电磁阀117断电,以使所述第一真空发生器111抽去所述Y轴气缸上的吸盘b内的空气,从而使得所述墙壁清洁机器人通过所述Y轴气缸上的吸盘b吸附在墙壁表面上。Control the third solenoid valve 103 and the first air path solenoid valve 117 to cut off the power, so that the first vacuum generator 111 sucks the air in the suction cup b on the Y-axis cylinder, so that the The wall cleaning robot is adsorbed on the wall surface through the suction cup b on the Y-axis cylinder.
参见图3至图5,在本发明实施例中,所述步骤S62具体为:Referring to Fig. 3 to Fig. 5, in the embodiment of the present invention, the step S62 is specifically:
当判断墙壁清洁机器人往X轴方向运动时,控制所述第四电磁阀104、所述第二气路电磁阀118通电以释放X轴气缸上的吸盘a,控制X轴气缸109往X 轴的正/反方向运动;并且,When it is judged that the wall cleaning robot is moving in the X-axis direction, the fourth electromagnetic valve 104 and the second air circuit electromagnetic valve 118 are controlled to be energized to release the sucker a on the X-axis cylinder, and the X-axis cylinder 109 is controlled to move toward the X-axis. forward/reverse direction movement; and,
在X轴气缸109往X轴的正/反方向运动之后,通过所述第四电磁阀104、所述第二气路电磁阀118断电,以使所述第二真空发生器112抽去所述X轴气缸上的吸盘a内的空气,从而使得所述墙壁清洁机器人通过X轴气缸上的吸盘a吸附在墙壁表面上,同时,通过所述第三电磁阀103、所述第一气路电磁阀117通电以释放Y轴气缸上的吸盘b,控制X轴气缸109回到原来的位置,以使墙壁清洁机器人往X轴的正/反方向运动;After the X-axis cylinder 109 moves in the positive/reverse direction of the X-axis, the fourth electromagnetic valve 104 and the second air circuit electromagnetic valve 118 are de-energized, so that the second vacuum generator 112 is pumped out. The air in the suction cup a on the X-axis cylinder, so that the wall cleaning robot is adsorbed on the wall surface through the suction cup a on the X-axis cylinder, and at the same time, through the third solenoid valve 103, the first air circuit The solenoid valve 117 is energized to release the suction cup b on the Y-axis cylinder, and controls the X-axis cylinder 109 to return to the original position, so that the wall cleaning robot moves in the positive/reverse direction of the X-axis;
所述步骤S63具体为:The step S63 is specifically:
当判断墙壁清洁机器人往Y轴方向运动时,通过所述第三电磁阀103、所述第一气路电磁阀117通电以控制Y轴气缸上的吸盘b通入空气,控制Y轴气缸110往Y轴的正/反方向运动;并且,When it is judged that the wall cleaning robot is moving in the Y-axis direction, the third solenoid valve 103 and the first air circuit solenoid valve 117 are energized to control the sucker b on the Y-axis cylinder to feed air, and the Y-axis cylinder 110 is controlled to move toward the Y-axis. Forward/reverse direction movement of the Y axis; and,
在Y轴气缸110往Y轴的正/反方向运动之后,通过所述第三电磁阀103、所述第一气路电磁阀117断电,以使所述第一真空发生器111抽去所述Y轴气缸上的吸盘b内的空气,从而使得所述墙壁清洁机器人通过Y轴气缸上的吸盘b 吸附在墙壁表面上,同时,通过所述第一电磁阀101、所述第二气路电磁阀118 通电以释放X轴气缸上的吸盘a,控制Y轴气缸110回到原来的位置,以使墙壁清洁机器人往Y轴的正/反方向运动。After the Y-axis cylinder 110 moves in the positive/reverse direction of the Y-axis, the third electromagnetic valve 103 and the first air circuit electromagnetic valve 117 are de-energized, so that the first vacuum generator 111 is pumped out. The air in the suction cup b on the Y-axis cylinder, so that the wall cleaning robot is adsorbed on the wall surface through the suction cup b on the Y-axis cylinder, and at the same time, through the first electromagnetic valve 101, the second air circuit The solenoid valve 118 is energized to release the suction cup a on the X-axis cylinder, and controls the Y-axis cylinder 110 to return to the original position, so that the wall cleaning robot moves in the positive/reverse direction of the Y-axis.
优选地,在本发明实施例中,所述墙壁清洁机器人还包括与所述控制器电连接的树莓派摄像头(图未示);所述步骤S2、检测墙壁清洁机器人是否处于清洁区域,若是,则启动清洁模式具体为:Preferably, in the embodiment of the present invention, the wall cleaning robot also includes a Raspberry Pi camera (not shown) electrically connected to the controller; the step S2, detecting whether the wall cleaning robot is in the cleaning area, if , then start the cleaning mode specifically as follows:
所述树莓派摄像头识别所述墙壁清洁机器人攀爬的区域,并将信号发送到所述控制器,所述控制器处理信号并进行清洁区域的判断;The raspberry pie camera recognizes the area where the wall cleaning robot climbs, and sends a signal to the controller, and the controller processes the signal and judges the cleaning area;
当判断所述墙壁清洁机器人处于非清洁区域时,则启动攀爬模式,控制X轴气缸109进行移动和/或控制Y轴气缸110进行移动以使所述墙壁清洁机器人攀爬至下一个清洁区域;When it is judged that the wall cleaning robot is in an unclean area, the climbing mode is started, the X-axis cylinder 109 is controlled to move and/or the Y-axis cylinder 110 is controlled to move so that the wall cleaning robot climbs to the next cleaning area ;
当判断所述墙壁清洁机器人处于清洁区域时,则启动清洁模式。When it is judged that the wall cleaning robot is in the cleaning area, the cleaning mode is started.
参见图3至图5,在本发明实施例中,所述墙壁清洁机器人还包括步进电机 223、同步带221,所述步进电机223的输出轴与所述同步带221连接,所述同步带221与所述清洁板22固定连接,所述步进电机223与所述控制器连接;所述步骤S4具体为:Referring to Fig. 3 to Fig. 5, in the embodiment of the present invention, the wall cleaning robot further includes a stepping motor 223 and a synchronous belt 221, the output shaft of the stepping motor 223 is connected with the synchronous belt 221, and the synchronous The belt 221 is fixedly connected to the cleaning plate 22, and the stepping motor 223 is connected to the controller; the step S4 is specifically:
在检测到墙壁清洁机器人固定在墙壁之后,控制清水抽水泵20工作,将清水集水箱21的水抽出至用于清洗墙壁表面的清洁板22;并且After detecting that the wall cleaning robot is fixed on the wall, the clean water pump 20 is controlled to work, and the water in the clean water collection tank 21 is pumped out to the cleaning plate 22 for cleaning the wall surface; and
控制步进电机223工作,以使步进电机223驱动同步带221,从而带动清洁板22往复移动;及Control the stepper motor 223 to work, so that the stepper motor 223 drives the timing belt 221, thereby driving the cleaning plate 22 to reciprocate; and
控制驱动电机工作,通过驱动电机驱动清洁板22上的滚刷222转动并在清水的辅助下清洗墙壁表面。The driving motor is controlled to work, and the rolling brush 222 on the cleaning plate 22 is driven to rotate by the driving motor and the wall surface is cleaned with the assistance of clear water.
在本发明实施例中,应当说明的是,所述步进电机223为4个,所述同步带221为2个所述同步带221呈H型,4个所述步进电机223共同驱动2个所述同步带221,从而带动所述清洁板22移动,进而扩大所述滚刷222与墙壁表面的接触面积,实现墙壁清洁机器人底部的大部分面积的清洗。In the embodiment of the present invention, it should be noted that there are four stepping motors 223, and two synchronous belts 221. The synchronous belts 221 are H-shaped, and the four stepping motors 223 jointly drive 2 The synchronous belt 221 is provided to drive the cleaning plate 22 to move, thereby expanding the contact area between the roller brush 222 and the wall surface, so as to realize the cleaning of most of the bottom area of the wall cleaning robot.
优选地,在本发明实施例中,所述墙壁清洁机器人还包括污水抽水泵23、过滤器25、用于收集清洁墙壁表面后的污水的污水集水箱,所述所述无水抽水泵与所述控制器电连接;所述步骤S4具体为:Preferably, in the embodiment of the present invention, the wall cleaning robot also includes a sewage water pump 23, a filter 25, and a sewage water collection tank for collecting sewage after cleaning the wall surface, and the anhydrous water pump and the Described controller is electrically connected; Described step S4 is specifically:
在检测到墙壁清洁机器人固定在墙壁之后,控制清水抽水泵20和驱动电机工作,将清水集水箱21的水抽出至用于清洗墙壁表面的清洁板22,通过驱动电机驱动清洁板22上的滚刷222转动并在清水的辅助下清洗墙壁表面;并且,After detecting that the wall cleaning robot is fixed on the wall, the clean water pump 20 and the driving motor are controlled to work, and the water in the clean water collection tank 21 is pumped out to the cleaning plate 22 for cleaning the wall surface, and the roller on the cleaning plate 22 is driven by the driving motor. The brush 222 rotates and cleans the wall surface with the aid of clean water; and,
控制所述污水抽水泵23将污水集水箱的水抽出并通过过滤器25输送至清水集水箱21中,从而形成清洁水循环。The sewage pump 23 is controlled to extract the water from the sewage collection tank and deliver it to the clean water collection tank 21 through the filter 25, thereby forming a clean water cycle.
在本发明实施例中,应当说明的是,清洁板22上设有进水口,当清水抽水泵20将清水集水箱21中的水抽至清洁板22后,流入清洁板22内的水经过滚刷 222,滚刷222在驱动电机的驱动下高速转动,从而在玻璃被湿润的情况下进行清洁,同时清水还能对滚刷222进行清洗,以保持滚刷222的洁净。清洁过玻璃的无水流入无水集水箱,由污水抽水泵23将污水抽回至清水集水箱21,且在这个循环过程中,过滤器25对污水进行过滤处理,从而在一定程度上将净化的水输送回清水集水箱21中进行储存,从而完成一个水循环。In the embodiment of the present invention, it should be noted that the cleaning plate 22 is provided with a water inlet. When the clean water pump 20 pumps the water in the clean water collection tank 21 to the cleaning plate 22, the water flowing into the cleaning plate 22 passes through the rolling The brush 222 and the rolling brush 222 rotate at a high speed under the drive of the driving motor, thereby cleaning the glass when it is wet, and the clear water can also clean the rolling brush 222 to keep the rolling brush 222 clean. The anhydrous glass that has been cleaned flows into the anhydrous water collection tank, and the sewage is pumped back to the clean water collection tank 21 by the sewage pump 23, and during this cycle, the filter 25 filters the sewage, thereby purifying the water to a certain extent The water transported back to the clear water collection tank 21 for storage, thereby completing a water cycle.
参见图3和图4,为了解决相同的技术问题,本发明还提供了一种墙壁清洁机器人控制系统,所述墙壁清洁机器人包括壳体,所述壳体上设有控制器和分别与所述控制器电连接的气泵100、清水抽水泵20、驱动电机、X轴气缸109以及 Y轴气缸110,所述X轴气缸109包括X轴滑块和X轴移动杆,所述X轴移动杆的两端上设有吸盘,且所述X轴滑块可滑动地连接在所述X轴移动杆上;所述Y轴气缸110包括Y轴滑块和Y轴移动杆,所述Y轴移动杆的两端上设有吸盘,且所述Y轴滑块可滑动地连接在所述Y轴移动杆上;所述控制器用于:Referring to Fig. 3 and Fig. 4, in order to solve the same technical problem, the present invention also provides a wall cleaning robot control system, the wall cleaning robot includes a housing, the housing is provided with a controller and the Air pump 100, clean water pump 20, drive motor, X-axis cylinder 109 and Y-axis cylinder 110 electrically connected to the controller, the X-axis cylinder 109 includes an X-axis slide block and an X-axis moving rod, and the X-axis moving rod Both ends are provided with suction cups, and the X-axis slider is slidably connected to the X-axis moving rod; the Y-axis cylinder 110 includes a Y-axis slider and a Y-axis moving rod, and the Y-axis moving rod There are suction cups on both ends, and the Y-axis slider is slidably connected to the Y-axis moving rod; the controller is used for:
控制用于提供动力来源的气泵100工作;Control the operation of the air pump 100 used to provide the power source;
检测墙壁清洁机器人是否处于清洁区域,若是,则启动清洁模式;Detect whether the wall cleaning robot is in the cleaning area, and if so, start the cleaning mode;
当清洁模式运行时,控制X轴气缸上的吸盘a和Y轴气缸上的吸盘b吸附在墙壁表面上,使得墙壁清洁机器人固定在墙壁上;When the cleaning mode is running, control the suction cup a on the X-axis cylinder and the suction cup b on the Y-axis cylinder to adsorb on the wall surface, so that the wall cleaning robot is fixed on the wall;
在检测到墙壁清洁机器人固定在墙壁之后,控制清水抽水泵20和驱动电机工作,将清水集水箱21的水抽出至用于清洗墙壁表面的清洁板22,通过驱动电机驱动清洁板22上的滚刷222转动并在清水的辅助下清洗墙壁表面;After detecting that the wall cleaning robot is fixed on the wall, the clean water pump 20 and the driving motor are controlled to work, and the water in the clean water collection tank 21 is pumped out to the cleaning plate 22 for cleaning the wall surface, and the roller on the cleaning plate 22 is driven by the driving motor. The brush 222 rotates and cleans the wall surface with the aid of clear water;
检测墙壁清洁机器人是否关闭清洁模式,若是,则控制清水抽水泵20和驱动电机停止工作,并启动攀爬模式;Detect whether the wall cleaning robot closes the cleaning mode, if so, then control the clean water pump 20 and the driving motor to stop working, and start the climbing mode;
当攀爬模式运行时,控制X轴气缸109进行X轴方向的移动和/或控制Y轴气缸110进行Y轴方向的移动以使所述墙壁清洁机器人攀爬至下一个清洁区域;When the climbing mode is running, control the X-axis cylinder 109 to move in the X-axis direction and/or control the Y-axis cylinder 110 to move in the Y-axis direction so that the wall cleaning robot climbs to the next cleaning area;
检测墙壁清洁机器人是否攀爬至下一个清洁区域,若是,则启动清洁模式。Detect whether the wall cleaning robot has climbed to the next cleaning area, and if so, start the cleaning mode.
参见图3和图4,在本发明实施例中,所述控制器还用于:Referring to Fig. 3 and Fig. 4, in the embodiment of the present invention, the controller is also used for:
攀爬模式运行时,判断墙壁清洁机器人是否往X轴方向运动或Y轴方向运动;When the climbing mode is running, judge whether the wall cleaning robot is moving in the X-axis direction or the Y-axis direction;
当判断墙壁清洁机器人往X轴方向运动时,控制X轴气缸上的吸盘a通入空气,控制X轴气缸109往X轴的正/反方向运动;并且,When it is judged that the wall cleaning robot is moving in the X-axis direction, the suction cup a on the X-axis cylinder is controlled to feed air, and the X-axis cylinder 109 is controlled to move in the positive/reverse direction of the X-axis; and,
在X轴气缸109往X轴的正/反方向运动之后,通过X轴气缸上的吸盘a吸附在墙壁表面上,同时释放Y轴气缸上的吸盘b,控制X轴气缸109回到原来的位置,以使墙壁清洁机器人往X轴的正/反方向运动;After the X-axis cylinder 109 moves to the positive/reverse direction of the X-axis, the suction cup a on the X-axis cylinder is adsorbed on the wall surface, and the suction cup b on the Y-axis cylinder is released at the same time, and the X-axis cylinder 109 is controlled to return to the original position , so that the wall cleaning robot moves in the positive/reverse direction of the X axis;
当判断墙壁清洁机器人往Y轴方向运动时,控制Y轴气缸上的吸盘b通入空气,控制Y轴气缸110往Y轴的正/反方向运动;并且,When it is judged that the wall cleaning robot is moving in the Y-axis direction, control the suction cup b on the Y-axis cylinder to feed air, and control the Y-axis cylinder 110 to move in the positive/reverse direction of the Y-axis; and,
在Y轴气缸110往Y轴的正/反方向运动之后,通过Y轴气缸上的吸盘b吸附在墙壁表面上,同时释放X轴气缸上的吸盘a,控制Y轴气缸110回到原来的位置,以使墙壁清洁机器人往Y轴的正/反方向运动。After the Y-axis cylinder 110 moves in the positive/reverse direction of the Y-axis, the suction cup b on the Y-axis cylinder is adsorbed on the wall surface, and at the same time the suction cup a on the X-axis cylinder is released to control the Y-axis cylinder 110 to return to its original position , so that the wall cleaning robot moves in the positive/reverse direction of the Y axis.
参见图3和图4,在本发明实施例中,所述墙壁清洁机器人还包括分别与控制器电连接的第一电磁阀101、第一方向电磁阀105、第二电磁阀102、第二方向电磁阀106,所述气泵100、所述第一电磁阀101、所述第一方向电磁阀105依次通过管路连接在X轴气缸109的进气端上,所述气泵100、所述第二电磁阀102、所述第二方向电磁阀106依次通过管路连接在Y轴气缸110的进气端上;所述控制器还用于:Referring to Fig. 3 and Fig. 4, in the embodiment of the present invention, the wall cleaning robot also includes a first solenoid valve 101, a first direction solenoid valve 105, a second solenoid valve 102, and a second direction solenoid valve electrically connected to the controller respectively. The solenoid valve 106, the air pump 100, the first solenoid valve 101, and the first direction solenoid valve 105 are sequentially connected to the intake end of the X-axis cylinder 109 through pipelines, and the air pump 100, the second The solenoid valve 102 and the second direction solenoid valve 106 are sequentially connected to the intake end of the Y-axis cylinder 110 through pipelines; the controller is also used for:
当判断墙壁清洁机器人往X轴方向运动时,控制X轴气缸上的吸盘a通入空气,通过所述第一电磁阀101通电、所述第一方向电磁阀105通电并由所述第一方向电磁阀105选择X轴气缸109往X轴的正/反方向进行运动;并且,When it is judged that the wall cleaning robot is moving in the X-axis direction, the sucker a on the X-axis cylinder is controlled to feed air, the first electromagnetic valve 101 is energized, the first direction electromagnetic valve 105 is energized, and the first direction electromagnetic valve 105 is energized. The solenoid valve 105 selects the X-axis cylinder 109 to move in the positive/reverse direction of the X-axis; and,
在X轴气缸109往X轴的正/反方向运动之后,通过X轴气缸上的吸盘a吸附在墙壁表面上,同时释放Y轴气缸上的吸盘b,通过所述第一方向电磁阀105 带动X轴气缸109回到原来的位置,以使墙壁清洁机器人往X轴的正/反方向运动;After the X-axis cylinder 109 moves in the positive/reverse direction of the X-axis, the suction cup a on the X-axis cylinder is adsorbed on the wall surface, and the suction cup b on the Y-axis cylinder is released at the same time, driven by the first direction solenoid valve 105 The X-axis cylinder 109 returns to its original position, so that the wall cleaning robot moves in the positive/reverse direction of the X-axis;
当判断墙壁清洁机器人往Y轴方向运动时,控制Y轴气缸上的吸盘b通入空气,通过所述第二电磁阀102通电、所述第二方向电磁阀106通电并由所述第二方向电磁阀106选择Y轴气缸110往Y轴的正/反方向进行运动;并且,When it is judged that the wall cleaning robot is moving in the Y-axis direction, the sucker b on the Y-axis cylinder is controlled to feed air, the second solenoid valve 102 is energized, the second direction solenoid valve 106 is energized, and the second direction The solenoid valve 106 selects the Y-axis cylinder 110 to move in the positive/reverse direction of the Y-axis; and,
在Y轴气缸110往Y轴的正/反方向运动之后,通过Y轴气缸上的吸盘b吸附在墙壁表面上,同时释放X轴气缸上的吸盘a,通过所述第二方向电磁阀106 带动Y轴气缸110回到原来的位置,以使墙壁清洁机器人往Y轴的正/反方向运动。After the Y-axis cylinder 110 moves in the positive/reverse direction of the Y-axis, the suction cup b on the Y-axis cylinder is adsorbed on the wall surface, and at the same time the suction cup a on the X-axis cylinder is released, and driven by the second direction solenoid valve 106 The Y-axis cylinder 110 returns to its original position, so that the wall cleaning robot can move in the positive/reverse direction of the Y-axis.
参见图3和图4,在本发明实施例中,所述墙壁清洁机器人还包括分别与所述控制器电连接的第三电磁阀103、第四电磁阀104、第一真空发生器111、第二真空发生器112、第一气路电磁阀117、第二气路电磁阀118;所述第三电磁阀 103、所述第一真空发生器111、所述第一气路电磁阀117通过管路连接在所述Y 轴气缸上的吸盘b上,所述第四电磁阀104、所述第二真空发生器112、所述第二气路电磁阀118通过管路连接在所述X轴气缸上的吸盘a上;所述控制器还用于:Referring to Fig. 3 and Fig. 4, in the embodiment of the present invention, the wall cleaning robot further includes a third solenoid valve 103, a fourth solenoid valve 104, a first vacuum generator 111, a Two vacuum generators 112, the first gas path solenoid valve 117, and the second gas path solenoid valve 118; the third solenoid valve 103, the first vacuum generator 111, and the first gas path solenoid valve 117 are The pipeline is connected to the suction cup b on the Y-axis cylinder, and the fourth solenoid valve 104, the second vacuum generator 112, and the second air solenoid valve 118 are connected to the X-axis cylinder through pipelines. on the suction cup a; the controller is also used for:
当清洁模式运行时,控制X轴气缸上的吸盘a和Y轴气缸上的吸盘b吸附在墙壁表面上,使得墙壁清洁机器人固定在墙壁上具体为:When the cleaning mode is running, control the suction cup a on the X-axis cylinder and the suction cup b on the Y-axis cylinder to adsorb on the wall surface, so that the wall cleaning robot is fixed on the wall. Specifically:
当清洁模式运行时,控制所述第四电磁阀104、所述第二气路电磁阀118断电,以使所述第二真空发生器112抽去所述X轴气缸上的吸盘a内的空气,从而使得所述墙壁清洁机器人通过所述X轴气缸上的吸盘a吸附在墙壁表面上;及When the cleaning mode is running, control the fourth solenoid valve 104 and the second air circuit solenoid valve 118 to cut off power, so that the second vacuum generator 112 can remove the vacuum in the suction cup a on the X-axis cylinder. air, so that the wall cleaning robot is adsorbed on the wall surface through the suction cup a on the X-axis cylinder; and
控制所述第三电磁阀103、所述第一气路电磁阀117断电,以使所述第一真空发生器111抽去所述Y轴气缸上的吸盘b内的空气,从而使得所述墙壁清洁机器人通过所述Y轴气缸上的吸盘b吸附在墙壁表面上。Control the third solenoid valve 103 and the first air path solenoid valve 117 to cut off the power, so that the first vacuum generator 111 sucks the air in the suction cup b on the Y-axis cylinder, so that the The wall cleaning robot is adsorbed on the wall surface through the suction cup b on the Y-axis cylinder.
在本发明实施例中,所述墙壁清洁机器人控制系统的工作原理是:In the embodiment of the present invention, the working principle of the wall cleaning robot control system is:
首先,由树莓派摄像头或超声波、激光传感器检测识别所述墙壁清洁机器人是否攀爬至清洁区域,若墙壁清洁机器人处于清洁区域,则启动清洁模式。First of all, whether the wall cleaning robot has climbed to the cleaning area is detected by the Raspberry Pi camera or ultrasonic and laser sensors. If the wall cleaning robot is in the cleaning area, the cleaning mode is started.
在清洁模式运行时,所述第一电磁阀101、所述第二电磁阀102、所述第三电磁阀103、所述第四电磁阀104均断电,以控制X轴气缸上的吸盘a和Y轴气缸上的吸盘b吸附在墙壁表面上,使得墙壁清洁机器人固定在墙壁上;同时,所述控制器通过PWM控制清水抽水泵20进行工作,将清水集水箱21的水抽出至用于清洗墙壁表面的清洁板22,控制驱动电机驱动清洁板22上的滚刷222转动并在清水的辅助下清洗墙壁表面;此外,所述控制器控制步进电机223带动所述清洁板22进行移动,以扩大清洁面积。When running in cleaning mode, the first solenoid valve 101, the second solenoid valve 102, the third solenoid valve 103, and the fourth solenoid valve 104 are all powered off to control the suction cup a on the X-axis cylinder And the suction cup b on the Y-axis cylinder is adsorbed on the wall surface, so that the wall cleaning robot is fixed on the wall; at the same time, the controller controls the clean water pump 20 to work through PWM, and the water in the clean water collection tank 21 is pumped out to the Clean the cleaning board 22 on the wall surface, control the drive motor to drive the roller brush 222 on the cleaning board 22 to rotate and clean the wall surface with the assistance of clear water; in addition, the controller controls the stepping motor 223 to drive the cleaning board 22 to move , to expand the cleaning area.
当关闭清洁模式时,控制所述第一电磁阀101、第四电磁阀104、第二气路电磁阀118通电,以使X轴气缸上的吸盘a脱离墙壁表面,而Y轴气缸上的吸盘b仍然吸附在墙壁表面上;通过所述第一方向电磁阀105调节X轴气缸109 移动的方向,当X轴气缸109移动至一定位置时,控制所述第四电磁阀104、所述第二气路电磁阀118断电,以使所述第一真空发生器111抽去X轴气缸上的吸盘a的空气,以使X轴气缸109固定在墙壁表面上,然后,所述控制器通过所述第三电磁阀103、所述第一气路电磁阀117通电,以使Y轴气缸上的吸盘b脱离墙壁表面,从而所述控制器控制所述第一方向电磁阀105调节X轴气缸109滑块的移动方向以使所述墙壁清洁机器人往X轴气缸109运动的方向进行运动,从而实现所述墙壁清洁机器人在X轴方向上的移动;同样的,所述墙壁清洁机器人往 Y轴方向进行移动的原理如X轴方向进行移动的原理一致,在此不做赘述。当所述树莓派摄像头检测到所述墙壁清洁机器人处于下一个清洁区域时,重新进入上述的清洁模式,依次循环,直到将每一清洁区域清洁完成。When the cleaning mode is turned off, the first electromagnetic valve 101, the fourth electromagnetic valve 104, and the second air circuit electromagnetic valve 118 are controlled to be energized so that the suction cup a on the X-axis cylinder is separated from the wall surface, and the suction cup a on the Y-axis cylinder b is still adsorbed on the wall surface; adjust the moving direction of the X-axis cylinder 109 through the first direction solenoid valve 105, and when the X-axis cylinder 109 moves to a certain position, control the fourth solenoid valve 104, the second The pneumatic solenoid valve 118 is de-energized so that the first vacuum generator 111 removes the air from the suction cup a on the X-axis cylinder, so that the X-axis cylinder 109 is fixed on the wall surface, and then the controller passes the The third electromagnetic valve 103 and the first air circuit electromagnetic valve 117 are energized so that the suction cup b on the Y-axis cylinder is separated from the wall surface, so that the controller controls the first direction electromagnetic valve 105 to adjust the X-axis cylinder 109 The moving direction of the slide block makes the wall cleaning robot move toward the direction of the X-axis cylinder 109 movement, thereby realizing the movement of the wall cleaning robot in the X-axis direction; similarly, the wall cleaning robot moves toward the Y-axis direction The principle of moving is the same as the principle of moving in the X-axis direction, and will not be repeated here. When the raspberry pie camera detects that the wall cleaning robot is in the next cleaning area, it will re-enter the above-mentioned cleaning mode and cycle in turn until each cleaning area is cleaned.
综上所述,本发明提供了一种墙壁清洁机器人控制方法及控制系统,具有如下有益效果:In summary, the present invention provides a wall cleaning robot control method and control system, which have the following beneficial effects:
6、通过X轴气缸和Y轴气缸在吸盘的辅助下进行交替运动,从而使得墙壁清洁机器人在二维平面的墙壁表面上进行攀爬运动,并保证了墙壁清洁机器人在运动过程中的稳定性和可靠性;6. Through the alternate movement of the X-axis cylinder and the Y-axis cylinder with the assistance of the suction cup, the wall cleaning robot can climb on the wall surface of the two-dimensional plane, and the stability of the wall cleaning robot during the movement is guaranteed and reliability;
7、当墙壁清洁机器人位于清洁区域时,滚刷在驱动电机的驱动下高速转动,并在清水的辅助下对墙壁表面进行清洗,从而提高清洗效率;7. When the wall cleaning robot is located in the cleaning area, the roller brush rotates at high speed under the drive of the drive motor, and cleans the wall surface with the help of clean water, thereby improving the cleaning efficiency;
8、墙壁清洁机器人在一个清洁区域完成清洁作业后,启动攀爬模式,使得墙壁清洁机器人攀爬至需要清洁的墙壁表面上;当攀爬至下一个清洁区域后,通过X轴气缸上的吸盘和Y轴气缸上的吸盘重新固定并处于在下一个清洁区域,启动清洁模式,以继续进行墙壁表面的清洁作业;8. After the wall cleaning robot completes the cleaning operation in a cleaning area, start the climbing mode, so that the wall cleaning robot climbs to the wall surface to be cleaned; when climbing to the next cleaning area, it passes through the suction cup on the X-axis cylinder And the suction cup on the Y-axis cylinder is fixed again and is in the next cleaning area, and the cleaning mode is started to continue the cleaning of the wall surface;
9、气泵不仅为X轴气缸上的吸盘和Y轴气缸上的吸盘提供吸力,还为X轴气缸和Y轴气缸的移动提供动力,以使墙壁清洁机器人能够在墙壁表面上进行运动;通过气泵、X轴气缸、Y轴气缸以及吸盘的配合工作,简化了墙壁清洁机器人的结构,降低墙壁清洁机器人的操作难度;9. The air pump not only provides suction for the suction cup on the X-axis cylinder and the suction cup on the Y-axis cylinder, but also provides power for the movement of the X-axis cylinder and the Y-axis cylinder, so that the wall cleaning robot can move on the wall surface; through the air pump , X-axis cylinder, Y-axis cylinder and the suction cup work together to simplify the structure of the wall cleaning robot and reduce the operation difficulty of the wall cleaning robot;
10、X轴气缸使得墙壁清洁机器人实现X轴方向直线运动,Y轴气缸使得墙壁清洁机器人实现Y轴方向的直线运动,从而通过两个方向直线运动合成下使得墙壁清洁机器人能够在二维平面的墙壁上进行自由运动。10. The X-axis cylinder enables the wall cleaning robot to achieve linear motion in the X-axis direction, and the Y-axis cylinder enables the wall cleaning robot to achieve linear motion in the Y-axis direction, so that the wall cleaning robot can move in a two-dimensional plane through the synthesis of linear motion in two directions. Free movement on the wall.
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,所述的程序可存储于一计算机可读取存储介质中,该程序在执行时,可包括如上述各方法的实施例的流程。其中,所述的存储介质可为磁碟、光盘、只读存储记忆体(Read-Only Memory,ROM)或随机存储记忆体(RandomAccessMemory,RAM)等。Those of ordinary skill in the art can understand that all or part of the processes in the methods of the above embodiments can be implemented through computer programs to instruct related hardware, and the programs can be stored in a computer-readable storage medium. During execution, it may include the processes of the embodiments of the above-mentioned methods. Wherein, the storage medium may be a magnetic disk, an optical disk, a read-only memory (Read-Only Memory, ROM) or a random access memory (Random Access Memory, RAM) and the like.
以上所述是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也视为本发明的保护范围。The above description is a preferred embodiment of the present invention, and it should be pointed out that for those skilled in the art, without departing from the principle of the present invention, some improvements and modifications can also be made, and these improvements and modifications are also considered Be the protection scope of the present invention.
Claims (10)
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201711280625.8A CN108056711A (en) | 2017-12-04 | 2017-12-04 | A kind of wall clean robot control method and control system |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201711280625.8A CN108056711A (en) | 2017-12-04 | 2017-12-04 | A kind of wall clean robot control method and control system |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN108056711A true CN108056711A (en) | 2018-05-22 |
Family
ID=62136245
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201711280625.8A Pending CN108056711A (en) | 2017-12-04 | 2017-12-04 | A kind of wall clean robot control method and control system |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN108056711A (en) |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111714023A (en) * | 2020-06-28 | 2020-09-29 | 中建八局装饰工程有限公司 | Glass curtain wall environmental protection cleaning device |
| CN112890655A (en) * | 2021-02-04 | 2021-06-04 | 安徽工程大学 | Robot for cleaning glass wall and using method thereof |
Citations (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN2053085U (en) * | 1989-04-13 | 1990-02-21 | 刘青松 | Floor washer |
| CN1205864A (en) * | 1997-07-23 | 1999-01-27 | 李仕清 | Floor-cleaning machine |
| CN1628589A (en) * | 2003-12-16 | 2005-06-22 | 胡佛公司 | Cleaning machines for cleaning surfaces |
| CN101023858A (en) * | 2006-02-20 | 2007-08-29 | 邓通讯 | Sweeping washing integrated machine |
| CN200978517Y (en) * | 2006-08-30 | 2007-11-21 | 麦永光 | High building outer wall wiping and spraying robot |
| WO2012137767A1 (en) * | 2011-04-04 | 2012-10-11 | Hayashi Kenji | Wall-surface travelling robot |
| CN202920086U (en) * | 2012-09-21 | 2013-05-08 | 苏州工业园区职业技术学院 | Control system of wireless wall surface cleaning robot |
| CN203153652U (en) * | 2013-04-10 | 2013-08-28 | 丽水学院 | Wall-climbing mechanism of high-rise glass cleaning robot and PLC control system |
| CN204641936U (en) * | 2015-05-13 | 2015-09-16 | 浙江工业大学 | Be applicable to the negative-pressure adsorption foot of the climbing robot of inclination hydraulically smooth surface |
| CN105235764A (en) * | 2015-10-30 | 2016-01-13 | 北京理工大学 | Vacuum suction wall-climbing robot and using method thereof |
-
2017
- 2017-12-04 CN CN201711280625.8A patent/CN108056711A/en active Pending
Patent Citations (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN2053085U (en) * | 1989-04-13 | 1990-02-21 | 刘青松 | Floor washer |
| CN1205864A (en) * | 1997-07-23 | 1999-01-27 | 李仕清 | Floor-cleaning machine |
| CN1628589A (en) * | 2003-12-16 | 2005-06-22 | 胡佛公司 | Cleaning machines for cleaning surfaces |
| CN101023858A (en) * | 2006-02-20 | 2007-08-29 | 邓通讯 | Sweeping washing integrated machine |
| CN200978517Y (en) * | 2006-08-30 | 2007-11-21 | 麦永光 | High building outer wall wiping and spraying robot |
| WO2012137767A1 (en) * | 2011-04-04 | 2012-10-11 | Hayashi Kenji | Wall-surface travelling robot |
| CN202920086U (en) * | 2012-09-21 | 2013-05-08 | 苏州工业园区职业技术学院 | Control system of wireless wall surface cleaning robot |
| CN203153652U (en) * | 2013-04-10 | 2013-08-28 | 丽水学院 | Wall-climbing mechanism of high-rise glass cleaning robot and PLC control system |
| CN204641936U (en) * | 2015-05-13 | 2015-09-16 | 浙江工业大学 | Be applicable to the negative-pressure adsorption foot of the climbing robot of inclination hydraulically smooth surface |
| CN105235764A (en) * | 2015-10-30 | 2016-01-13 | 北京理工大学 | Vacuum suction wall-climbing robot and using method thereof |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111714023A (en) * | 2020-06-28 | 2020-09-29 | 中建八局装饰工程有限公司 | Glass curtain wall environmental protection cleaning device |
| CN112890655A (en) * | 2021-02-04 | 2021-06-04 | 安徽工程大学 | Robot for cleaning glass wall and using method thereof |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN1302898C (en) | Robot dust collector, robot dust collector system and its control method | |
| CN1313045C (en) | Air cleaning robot and system thereof | |
| EP3669738A1 (en) | Automated floor cleaning apparatus | |
| CN108888167B (en) | High-altitude cleaning unmanned aerial vehicle and method for cleaning building high altitude by using same | |
| CN109744930B (en) | A multi-suction cup high-altitude glass curtain wall cleaning robot | |
| CN102727144B (en) | Multifunctional robot and its control device and method for automatic separation of functional modules | |
| EP0990750B1 (en) | Apparatus and method of operation for high-speed swimming pool cleaner | |
| EP2721987A2 (en) | Method of controlling automatic cleaner | |
| CN105615763A (en) | Three-sucker type cleaning device and control method thereof | |
| CN104605784B (en) | Safe and smart glass cleaner that can climb over obstacles | |
| JP2005230044A (en) | Autonomous running robot cleaner | |
| CN206543159U (en) | Floor cleaning device, aircleaning facility and two-in-one device | |
| CN108056711A (en) | A kind of wall clean robot control method and control system | |
| CN108720709A (en) | Window wiping systems and its control method based on laser ranging walking | |
| CN203379066U (en) | Automatic window-cleaning robot | |
| CN114376437B (en) | A glass exterior wall cleaning robot | |
| CN114903376A (en) | An adaptive stair cleaning robot | |
| CN105433877A (en) | Dust collecting box for cleaning robot, cleaning robot and control method | |
| KR102122236B1 (en) | Robot cleaner and method for controlling the robot cleaner | |
| CN110974081A (en) | Intelligent glass cleaning robot and autonomous moving method | |
| CN103191895A (en) | Wall-climbing robot capable of turning around vertically | |
| CN202136279U (en) | Multifunctional robot system | |
| CN107788902A (en) | A kind of glass curtain wall cleaning machine device people that there is the back of the body to push away propeller | |
| CN208659198U (en) | A kind of wall surface cleaner device people | |
| CN213862464U (en) | Frame type wall-climbing robot |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| RJ01 | Rejection of invention patent application after publication | ||
| RJ01 | Rejection of invention patent application after publication |
Application publication date: 20180522 |