摆动式自行走擦窗机器人及其控制方法
【技术领域】
[0001]本发明涉及一种机器人及其控制方法，尤其涉及一种摆动式自行走擦窗机器人及其控制方法。
【背景技术】
[0002]市场上目前已经有了多种类型的擦窗机，并采用数种不同的技术控制擦窗机的行走动作。目前现有的擦窗机器人行走动作采用的技术主要有:
[0003]手动式行走方式:一般采用内外式永久磁铁吸附方式，需要人工操作，对于厚玻璃或双层玻璃吸附力减弱，存在制约；
[0004]履带行走式:履带行走式一般采用真空吸附加履带形成行走装置，该机构可以实现自动行走动作，但机构复杂，存在擦窗死角或遗留履带行走擦痕；另外这种方式拭布与被擦平面相对运动少，影响擦拭效果。
[0005]机械腿方式:机械腿行走式一般采用真空吸盘式，也可以实现自动行走动作。但同样机构复杂，行走动作复杂等问题。
【发明内容】
[0006]本发明所要解决的技术问题是提供一种摆动式自行走擦窗机器人及其控制方法，能够大大改善擦拭效果，同时让擦窗机器人在结构上大大简化，消除擦痕，并有效将擦窗死区降至最低。
[0007]本发明为解决上述技术问题而采用的技术方案是提供一种摆动式自行走擦窗机器人，包括行走电机和两个擦窗转盘，所述行走电机和电机驱动电路相连并通过蜗轮蜗杆机构带动擦窗转盘转动，其中，所述擦窗转盘设于真空吸盘上，所述真空吸盘和真空泵相连，所述真空吸盘和擦窗转盘处于同心位置，所述两个真空吸盘与真空泵之间连通形成真空气腔。
[0008]上述的摆动式自行走擦窗机器人，其中，所述电机驱动电路的输入端和中央处理器的输出端相连，所述电机驱动电路的输出端和行走电机以及真空泵的电机相连；所述中央处理器的电源端通过电压转换电路和输入电源相连，所述中央处理器(通过SPI接口和运动检测电路相连获取擦窗转盘的运动状态轨迹。
[0009]上述的摆动式自行走擦窗机器人，其中，所述中央处理器通过遥控器收发电路和遥控接收器相连，所述遥控接收器为内外双向红外接收装置。
[0010]上述的摆动式自行走擦窗机器人，其中，所述电压转换电路的输出端通过充电控制电路和充电电池相连，所述充电电池和中央处理器、遥控接收器以及真空泵的电源端相连。
[0011]本发明为解决上述技术问题还提供一种上述摆动式自行走擦窗机器人的控制方法，包括如下步骤:a)控制两个行走电机同时逆时针/顺时针转动，并调整两个行走电机的快慢速度实现倾斜角度变化山)控制两个行走电机采用相反转向以及交替快慢速度调整，实现反方向摆动；C)当调整正反方向摆动角度一致后，控制擦窗机器人沿水平方向或垂直方向的正反向行走；e)当调整正反向摆动角度不一致时，设置其中一侧的摆动角度为O，控制擦窗机器人沿该侧边界下移。
[0012]上述的摆动式自行走擦窗机器人的控制方法，其中，所述步骤a)中擦窗机器人还内置陀螺仪及加速度计检测倾斜角变化，使得擦窗机器人到达指定倾斜角时自动停止。
[0013]上述的摆动式自行走擦窗机器人的控制方法，其中，所述真空泵的电机为直流有刷电机，所述电机驱动电路通过调整PWM占空比来调节真空泵吸力。
[0014]本发明对比现有技术有如下的有益效果:本发明提供的摆动式自行走擦窗机器人及其控制方法，通过采用真空吸盘式吸附装置，同时将擦窗转盘当作行走机构完成摆动式行走动作，将吸附，行走及擦拭动作合一，可以最大地提高拭布与玻璃的相对运动，改善擦拭效果同时让擦窗机器人在结构上大大简化，消除擦痕，并有效将擦窗死区降至最低。
【附图说明】
[0015]图1为本发明摆动式自行走擦窗机器人正面结构示意图；
[0016]图2为本发明摆动式自行走擦窗机器人反面结构示意图；
[0017]图3为本发明摆动式自行走擦窗机器人的控制电路方框示意图；
[0018]图4为本发明摆动式自行走擦窗机器人摆动式正向行走示意图；
[0019]图5为本发明摆动式自行走擦窗机器人摆动式反向行走示意图；
[0020]图6为本发明摆动式自行走擦窗机器人右边界摆动式下移示意图；
[0021]图7为本发明摆动式自行走擦窗机器人左边界摆动式下移示意图。
[0022]图中:
[0023]I擦窗转盘2行走电机3真空气腔
[0024]4真空吸盘5真空泵6蜗轮蜗杆驱动机构
[0025]7遥控接收器8安全绳9充电电池
[0026]10电机驱动电路 11中央处理器 12充电控制电路
[0027]13运动检测电路 14遥控器收发电路15电压转换电路
【具体实施方式】
[0028]下面结合附图和实施例对本发明作进一步的描述。
[0029]图1为本发明摆动式自行走擦窗机器人正面结构示意图；图2为本发明摆动式自行走擦窗机器人反面结构示意图。
[0030]请参见图1，本发明提供的摆动式自行走擦窗机器人，包括行走电机2和两个擦窗转盘I，所述行走电机2和电机驱动电路10相连并通过蜗轮蜗杆机构6带动擦窗转盘I转动，其中，所述擦窗转盘I设于真空吸盘4上，所述真空吸盘4和真空泵5相连，所述真空吸盘4和擦窗转盘I处于同心位置，所述两个真空吸盘4与真空泵5之间连通形成真空气腔3。
[0031 ] 本发明提供的摆动式自行走擦窗机器人，如图3所示，其中，所述电机驱动电路10的输入端和中央处理器11的输出端相连，所述电机驱动电路10的输出端和行走电机2以及真空泵5的电机相连；所述中央处理器11的电源端通过电压转换电路15和输入电源相连，所述中央处理器11通过SPI接口和运动检测电路13相连获取擦窗转盘I的运动状态轨迹。所述中央处理器11通过遥控器收发电路14和遥控接收器7相连，所述遥控接收器7为内外双向红外接收装置。所述电压转换电路15的输出端通过充电控制电路12和充电电池9相连，所述充电电池9和中央处理器11、遥控接收器7以及真空泵5的电源端相连。
[0032]本发明提供的摆动式自行走擦窗机器人，各主要部件的功能如下:
[0033]两个擦窗转盘:行走电机2直接通过蜗轮蜗杆机构6驱动擦窗转盘I转动，同时完成转动擦拭及摆动行走动作；相对于履带式擦窗机器人，大大增加了擦拭相对运动。擦窗转盘上可以套装可更换的清洁布。
[0034]两个行走电机:行走电机2通过涡轮蜗杆机构6带动擦窗转盘I转动，完成擦拭及行走动作；行走电机2类型为直流有刷电机。
[0035]真空气腔:位置处于两个真空吸盘4与真空泵5之间联通的空间，并与其他位置相对隔离。真空泵5转动后形成从真空吸盘4至真空泵飞轮的气流并形成真空气腔与外界的负压，从而形成吸盘效应。
[0036]真空吸盘:真空吸盘4完成吸附动作，真空吸盘4位置与擦窗转盘I处于同心位置，通过擦拭清洁布与被擦平面形成吸附效应。吸力大小可以调整，可以同时保证吸附可靠性与行走平滑性以及清洁效果。
[0037]真空泵电机:真空泵电机运行后在真空气腔形成负压从而产生吸盘吸力，通过电机扭矩调整调整真空吸盘吸力，使得机器人吸附可靠性与行走擦拭效果之间达到平衡
[0038]涡轮蜗杆机构:行走电机2与擦窗转盘I之间的减速装置，采用涡轮蜗杆及行星齿轮机构。
[0039]遥控接收器:采用内外双向红外接收装置，保证擦窗机器人可以工作在被擦平面的内外两面，正常接收到遥控信号。
[0040]安全绳:安全绳8为本发明装置擦窗机器人的二级防护装置。在主电源停电，且可充电电池放电完毕时进一步防止装置脱落。
[0041]充电电池:主