误差检测方法及使用该误差检测方法的自走式装置制造方法及图纸

本发明专利技术提供一种误差检测方法及使用该误差检测方法的自走式装置，包括：使一驱动单元驱动一自走式装置的一本体于一地面上移动，并以一第一感测单元感测该驱动单元的作动状态；使一控制单元由该驱动单元的作动状态获得该本体移动速度的预设值；使一第二感测单元感测该本体相对该地面的移动状态；使该控制单元由该本体相对该地面的移动状态获得该本体移动速度的实际值；当该本体移动速度的预设值与实际值不对应时，该控制单元判断该本体的移动有误差状态的发生。

【技术实现步骤摘要】
误差检测方法及使用该误差检测方法的自走式装置
本专利技术有关于一种误差检测方法及使用该误差检测方法的自走式装置，尤指一种可判断在地面上自动移动的自走式装置发生移动误差的误差检测方法及使用该误差检测方法的自走式装置。
技术介绍
已知例如扫地机器人、自动导引车(AGV；AutomatedGuidedVehicle)…等受驱动轮驱动于预设空间的地面上移动的自走式装置，其上设有多种传感器以感测该自走式装置的旋转角度或移动距离，例如以陀螺仪(Gyroscope)感测该自走式装置的旋转角度、以编码器(Encoder)感测该驱动轮的转动频率以换算该自走式装置移动的距离；这些旋转角度与移动距离的信息经由一控制器运算后，可知该自走式装置在该预设空间内的移动轨迹；为了便于使用者掌握该自走式装置在该预设空间内的位置以利后续操控，通常会在该自走式装置或一外部操控装置上设置一显示器，用以显示该预设空间的地图信息与该自走式装置在该地图上的位置。
技术实现思路
已知自走式装置是借由编码器(Encoder)感测该驱动轮的转动频率以换算该自走式装置移动的距离，但驱动轮在地面转动使自走式装置移动时，驱动轮可能会发生空转打滑的情形，导致虽然编码器感测到驱动轮有转动，但实际上驱动轮的转动并没有造成自走式装置的移动，最后产生移动误差；以如图1为例作说明，控制器运算自走式装置在预设空间已由A位置移动一预设距离至B位置，并在B位置转向后再移动一预设距离至C位置，其预设的位移路径为Z；但在驱动轮发生空转打滑的情形下，该自走式装置的移动距离将不符合预设结果，该自走式装置实际上先移动至D位置后，再转向移动至E位置，其实际的位移路径为Z'，若该自走式装置继续移动，则控制器运算的轨迹与位置的移动误差将逐渐扩大。爰是，本专利技术的目的，在于提供一种可检测发生误差情形的误差检测方法。本专利技术的另一目的，在于提供一种可检测发生误差情形的自走式装置。依据本专利技术目的的误差检测方法，包括：使一驱动单元驱动一自走式装置的一本体于一地面上移动，并以一第一感测单元感测该驱动单元的作动状态；使一控制单元由该驱动单元的作动状态获得该本体移动速度的预设值；使一第二感测单元感测该本体相对该地面的移动状态；使该控制单元由该本体相对该地面的移动状态获得该本体移动速度的实际值；当该本体移动速度的预设值与实际值不对应时，该控制单元判断该本体的移动有误差状态的发生。依据本专利技术目的的自走式装置，包括：用以执行如所述误差检测方法的自走式装置。本专利技术实施例的误差检测方法及使用该误差检测方法的自走式装置，该控制单元可先由该第一感测单元感测该驱动单元的作动状态以获得该本体移动速度的预设值，并由该第二感测单元感测该本体相对该地面的移动状态以获得该本体移动速度的实际值；再比对该本体移动速度的预设值与实际值有无对应，当不对应时，该控制单元则判断该本体的移动有误差状态的发生。【附图说明】图1是本专利技术实施例中自走式装置正常行走状态与误差状态下移动路径的示意图。图2是本专利技术实施例中自走式装置的各功能单元配置的示意图。图3是本专利技术实施例中第一感测单元感测信号的示意图。图4是本专利技术实施例中自走式装置的第二感测单元感测脉波的示意图。图5是本专利技术实施例中自走式装置的第二感测单元感测脉波的示意图。图6是本专利技术实施例中自走式装置的第二感测单元感测脉波的示意图。【具体实施方式】请参阅图2，本专利技术实施例的误差检测方法可使用如图所示的可于地面W上自动行走执行预设作业的自走式装置作说明，该自走式装置可例如扫地机器人、自动巡检机器人…等，其设有包括：一本体A；一驱动单元B，用以驱动该本体A于该地面W上自动移动；该驱动单元B设有包括一动力组件B1与多个驱动轮B2；该动力组件B1设于该本体A内，可由包括马达与齿轮等所组成；该驱动轮B2设于该本体A下方与该地面W接触；一第一感测单元C，用以感测该驱动单元B的作动状态；该第一感测单元C可以一例如光学或磁力式的旋转编码器感测该动力组件B1中马达或齿轮的转动频率，亦或直接感测该驱动轮B2的转动频率；一第二感测单元D，用以感测该本体A相对该地面W的移动状态；该第二感测单元D可以一例如电磁、声波或光学式的都普勒传感器朝该地面W发射一脉波并接收由该地面W反射的脉波；一障碍感测单元E，用以感测该本体A行走方向上的障碍物或段差；该障碍感测单元E设有包括一障碍物传感器E1与一段差传感器E2；该障碍物传感器E1设于该本体A前侧周缘朝移动方向前方检测，可例如光学、声波或影像的传感器；该段差传感器E2设于该本体A前侧下方朝该本体A下方的地面W检测，可例如光学、声波的传感器；一控制单元F，用以计算该本体A在一地图内的位置与执行各项数据运算或判断以进行各单元的控制；该动力组件B1或驱动轮B2的转动频率经该控制单元F运算可获得该本体A预设上的移动速度与距离，另配合一例如陀螺仪(Gyroscope)的角度传感器F1感测该本体A的旋转角度，该旋转角度与移动距离的移动信息经该控制单元F计算后，可知该本体A在该地图上的移动轨迹。请参阅图2、3，该动力组件B1可驱动该本体A下方的驱动轮B2转动，使该驱动轮B2带动该本体A相对该地面W进行移动；该驱动单元B的动力组件B1或驱动轮B2在转动时，该第一感测单元C会感测到间歇性地信号，故可由在单位时间内有无感测到信号以感测该驱动单元B的作动状态，并可以单位时间内的信号感测频率感测该驱动单元B的动力组件B1或驱动轮B2的转动频率；当单位时间内信号感测频率较密集时，表示该驱动单元B以较快的转速驱动该本体A移动；当单位时间内信号感测频率较松散时，表示该驱动单元B以较慢的转速驱动该本体A移动；当单位时间内皆无信号感测时，表示该驱动单元B无驱动该本体A移动。请参阅图2，该本体A相对该地面W进行移动时，该第二感测单元D可由脉波强度的高低差感测该本体A的移动状态，并可以单位时间内的脉波感测频率经该控制单元F运算以获得该本体A实际上相对该地面W的移动速度；在判断脉波强度的高低差时，以每一脉波强度的最大值与最小值相减所得的一量测值与一预设值相比较，若大于该预设值则该本体A有相对该地面W进行移动，若低于该预设值则该本体A无相对该地面W进行移动：以图4为例，假设预设值为10，每一脉波强度的最大值为20，每一脉波强度的最小值为5，故量测值为15，因15大于10，故可知该本体A有相对该地面W移动，且在图4中，单位时间内脉波感测频率较密集，表示该本体A在该地面W上以较快速度移动；以图5为例，假设预设值为10，每一脉波强度的最大值为20，每一脉波强度的最小值为5，故量测值为15，因15大于10，故可知该本体A有相对该地面W移动，又因图5中，单位时间内脉波感测频率较松散时，表示该本体A在该地面W上以较慢速度移动；以图6为例，假设预设值为10，每一脉波强度的最大值为13，每一脉波强度的最小值为9，故量测值为4，因4小于10，故可知该本体A无相对该地面W移动。<本文档来自技高网...

【技术保护点】
1.一种误差检测方法，包括：/n使一驱动单元驱动一自走式装置的一本体于一地面上移动，并以一第一感测单元感测该驱动单元的作动状态；使一控制单元由该驱动单元的作动状态获得该本体移动速度的预设值；/n使一第二感测单元感测该本体相对该地面的移动状态；使该控制单元由该本体相对该地面的移动状态获得该本体移动速度的实际值；/n当该本体移动速度的预设值与实际值不对应时，该控制单元判断该本体的移动有误差状态的发生。/n

【技术特征摘要】
20181226 TW 1071472761.一种误差检测方法，包括：
使一驱动单元驱动一自走式装置的一本体于一地面上移动，并以一第一感测单元感测该驱动单元的作动状态；使一控制单元由该驱动单元的作动状态获得该本体移动速度的预设值；
使一第二感测单元感测该本体相对该地面的移动状态；使该控制单元由该本体相对该地面的移动状态获得该本体移动速度的实际值；
当该本体移动速度的预设值与实际值不对应时，该控制单元判断该本体的移动有误差状态的发生。


2.如权利要求1所述误差检测方法，其特征在于，该驱动单元设有一动力组件与一驱动轮，该第一感测单元以一旋转编码器感测该动力组件或该驱动轮的转动频率，并由该控制单元运算为该本体移动速度的预设值。


3.如权利要求1所述误差检测方法，其特征在于，该控制单元用以计算该本体在一地图内的位置；该本体的移动信息经该控制单元计算后，以获得该本体在该地图上的移动轨迹。


4.如权利要求3所述误差检测方法，其特征在于，若该本体移动速度的预设值与实际值相对应时，则该控制单元判断为正常...

【专利技术属性】
技术研发人员：陈志峰，
申请(专利权)人：万润科技股份有限公司，
类型：发明
国别省市：中国台湾;71