避障与防掉落系统及其方法

摘要

一种避障与防掉落系统及其方法，其是在一可移动的本体上设置至少一位移传感器，该位移传感器可由一转动装置驱动在一定角度的扇型范围内或全圆周旋转扫描侦测，设定该位移传感器的发射及接收讯号的路径与该本体所设置的平面成一特定角度并初始化使产生一工作讯号，由该位移传感器发送及接收讯号，并将所接收的讯号传送至一控制单元，再由该控制单元接收该接收讯号并与工作讯号进行比较运算，以判断行进方向具有障碍物或高度落差，并驱动该本体转向，达到避障与防止掉落的功能，可大幅简化移动装置的设计及装置成本。

主权项

一种避障与防掉落系统，其特征在于，其包含：一本体；至少一驱动轮，是设置在该本体，用在支撑及移动该本体；至少一声波传感器形式的位移传感器，其设置在该本体，用以发射及接收讯号，其发射及接收讯号的路径是与该本体所设置的平面成一特定角度，所述特定角度大于0度且小于90度；一转动装置，是设置在该本体，用以驱动该位移传感器在一定角度的扇形范围内或全圆周旋转扫描侦测；一控制单元，是设置在该本体，接收及处理该位移传感器的讯号，以判断行进方向是否有障碍物或高度落差，并输出一讯号以驱动该本体转向；其中，将传感器正常状态的反射讯号作为预设的工作讯号Sw，并由控制单元将当前反射讯号SR与工作讯号Sw进行比较，SR＜Sw则判断为前方有障碍物，执行避障算法；SR＞Sw则判断为前方有凹陷处，执行防掉落算法。