一种检测楼梯高度和深度的触角式探测装置及方法
【技术领域】
[0001]本发明涉及了一种适用于爬楼机器人检测所爬楼梯高度和深度的方法，利用触角式探测装置上的碰撞传感器，角度传感器，整合机械腿上的超声波传感器检测的信息，精确计算出楼梯高度和深度，使爬楼机器人能够根据不同楼梯调整相应动作。
【背景技术】
[0002]爬楼机器人是利用两组电动推杆分别抬升，并在一组推杆抬升的时候，利用步进电机控制另一组被悬空的推杆向前运动来实现爬楼的基本动作。本发明的触角式探测装置是利用超声波传感器测距，角度传感器测量触角所转角度，通过单片机程序实现楼梯高度和深度的测量。
【发明内容】
[0003]本发明的目的是提供一种检测楼梯高度和深度的触角式探测装置及方法，实现楼梯高深度的自动检测可以帮助爬楼机器人调整腿部抬升的高度和悬空的推杆向前移动的距离，从而实现爬楼机器人适应各种楼梯的功能。
[0004]为了达到上述目的，本发明提供了一种检测楼梯高度和深度的触角式探测装置，其特征在于，包括:超声波传感器和触角式探测装置，所述的超声波传感器设于爬楼机器人的机械腿的外壁底部并可随机械腿的抬升而抬升，所述的触角式探测装置包括支撑架，所述的支撑架固定在爬楼机器人机械腿的外壁上，支撑架上设有电机和L形触角驱动轴，L形触角驱动轴上设有L形触角，电机可经由L形触角驱动轴带动L形触角旋转，所述的L形触角驱动轴上设有角度传感器，L形触角的前端设有碰撞传感器。
[0005]优选地，所述的超声波传感器的高度低于楼梯的单个台阶的高度h。
[0006]优选地，所述的L形触角驱动轴的高度Ha大于楼梯的单个台阶的高度h，且小于楼梯的两个台阶的高度2h。
[0007]优选地，所述的电机、超声波传感器、角度传感器和碰撞传感器均连接单片机。
[0008]本发明还提供了一种采用上述的检测楼梯高度和深度的触角式探测装置检测楼梯深度的方法，其特征在于，包括:在爬楼机器人向楼梯前进的过程中，利用超声波传感器测量爬楼机器人的机械腿离楼梯底部的距离，达到指定距离S后，爬楼机器人停止前进，启动触角式探测装置，使L形触角逆时针旋转，当碰撞传感器传出发生碰断信号时，电机停转，L形触角停止转动；控制爬楼机器人的机械腿抬升，在抬升过程中，超声波传感器检测到距离值会发生突变，将突变后的值Z记录，与指定距离S相减，得到楼梯的深度X = Z-So
[0009]本发明还提供了一种采用上述的检测楼梯高度和深度的触角式探测装置检测楼梯高度的方法，其特征在于，包括:
[0010]第一步:在爬楼机器人向楼梯前进的过程中，利用超声波传感器测量爬楼机器人的机械腿离楼梯底部的距离，达到指定距离S后，爬楼机器人停止前进，启动触角式探测装置，使L形触角逆时针旋转，当碰撞传感器传出发生碰断信号时，电机停转，L形触角停止转动；读取此时的角度传感器所测量到的旋转角度Φ，控制触角式探测装置返回原位；
[0011]第二步，通过旋转角度φ，触角长度L，触角深度B，L形触角驱动轴的高度Ha，指定距离S，计算楼梯的高度h，计算过程为:定义L形触角的外壁与L形触角驱动轴的高度Ha处的水平面的交点与L形触角的顶角之间的距离BI为辅助触角深度，由几何分析可知:
[0012]BI = L/tanΦ (a)，
[0013]且Ha_h/(B-Bl) = sin? (b)，
[0014]由式(a)和式(b)得到楼梯的高度h = Ha-Bsini>+LcosC>。
[0015]本发明模仿蚂蚁触角探测功能，利用超声波获得的距离信息，到达指定距离后进行动作，具体动作是通过控制电机逆时针旋转，在旋转过程中接收到碰撞传感器的碰撞信息时，控制电机停转并记录当前角度传感器的角度信息，计算楼梯高度，随后再控制电机顺时针旋转将触角式探测装置返回原位。
[0016]与现有技术相比，本发明具有以下有益效果:
[0017]1、本发明利用简单的机械装置，针对实际使用中的楼梯高度，深度都在一定的范围的特点，配合传感器采取必要信息，直接通过运算公式得到楼梯信息，成本低廉，技术简单，分辨率高，信息准确，可以适用推广于其他自动检测装置。
[0018]2、可适用与其他自动检验装置，原理清晰，技术成熟，装置简单，成本低廉，可推广型强；
[0019]3、可自由选择安装位置，只需给定初始距离信息，可方便得出高度信息；
[0020]4、可适应楼梯高深度的不同变化，采用单片机进行中心控制，测量精度高，易实现批量生产。
【附图说明】
[0021]图1为检测楼梯高度和深度的触角式探测装置结构示意图；
[0022]图2为本发明的应用示意图；
[0023]图3为本发明的计算原理图。
【具体实施方式】
[0024]下面结合具体实施例，进一步阐述本发明。应理解，这些实施例仅用于说明本发明而不用于限制本发明的范围。此外应理解，在阅读了本发明讲授的内容之后，本领域技术人员可以对本发明作各种改动或修改，这些等价形式同样落于本申请所附权利要求书所限定的范围。
[0025]实施例
[0026]如图1所示，本发明的检测楼梯高度和深度的触角式探测装置，包括:超声波传感器I和触角式探测装置，所述的超声波传感器2设于爬楼机器人的机械腿5的外壁底部并可随机械腿5的抬升而抬升，所述的触角式探测装置包括支撑架，所述的支撑架固定在爬楼机器人机械腿5的外壁上，支撑架上设有电机和L形触角驱动轴，L形触角驱动轴上设有L形触角4，电机可经由L形触角驱动轴带动L形触角4旋转，所述的L形触角驱动轴上设有角度传感器3，L形触角4的前端设有碰撞传感器2。所述的超声波传感器2的高度低于楼梯的单个台阶的高度h。所述的L形触角驱动轴的高度Ha大于楼梯的