一种机器人控制方法及全向移动机器人技术

本发明专利技术公开了一种机器人控制方法，包括：确定机器人的当前位置及目标位置；计算从当前位置到目标位置的最优路径，并将最优路径分解为多段直线路径，确定机器人在每段直线路径中所需的姿态和平移策略；根据机器人在每段直线路径中所需的姿态和平移策略，在每段直线路径中先控制机器人进行姿态调整，再控制机器人进行位置平移，直至机器人到达目标位置。本发明专利技术提供的机器人控制方法，通过分段定位，将规划的最优路径进行提前分解，再进行逐级逼近的控制方法，使机器人的控制算法更加简单，实现机器人快速平稳的精确定位，提高机器人在移动过程中的稳定性。程中的稳定性。程中的稳定性。

【技术实现步骤摘要】
一种机器人控制方法及全向移动机器人


[0001]本专利技术涉及移动机器人
，特别是涉及一种机器人控制方法及全向移动机器人。

技术介绍

[0002]目前，机器人定位大多通过速度控制、动态纠偏的方式，根据机器人当前的运动方向和速度与目标值比较，实时纠正机器人的移动路径及姿态。
[0003]现有技术中使用的差速轮实时纠偏控制算法中，需要知道机器人的实时方向和姿态，由于机器人是动态运行的，且位置反馈具有一定滞后性，造成机器人控制算法复杂，且准确性不高。基于在线的实时纠偏速度控制算法，由于电机驱动、驱动轮同步性差，响应时间不一致，造成调整偏差，提高动态响应时容易造成超调，使机器人行走不稳定。
[0004]综上，移动机器人采用实时纠偏的算法，需对实际转速及方向进行控制，算法复杂，低响应时，纠偏速度慢，轨迹偏离远；高响应时，又容易发生扭摆振荡，造成难以获得稳定参数的问题，并且对不同工况及不同设备状态影响较大，从而在机器人快速移动时，参数难以调节，稳定性较差。因此，有必要提供改进的技术方案以克服现有技术中存在的以上技术问题。

技术实现思路

[0005]鉴于上述问题，本专利技术的目的在于提供一种机器人控制方法，提高机器人运行的稳定性。
[0006]本专利技术提供一种机器人控制方法，包括：确定机器人的当前位置及目标位置；计算从所述当前位置到所述目标位置的最优路径，并将所述最优路径分解为多段直线路径，确定所述机器人在每段所述直线路径中所需的姿态和平移策略；根据所述机器人在每段所述直线路径中所需的姿态和平移策略，在每段所述直线路径中先控制所述机器人进行姿态调整，再控制所述机器人进行位置平移，直至所述机器人到达所述目标位置。
[0007]进一步地，所述机器人在每段所述直线路径中所需的平移策略包括多种具有不同的平移速度及定位精度的子策略；所述在每段所述直线路径中控制所述机器人进行位置平移包括：控制所述机器人依次按照所述多种子策略进行平移和定位，直至到达所述直线路径的终点。
[0008]进一步地，所述子策略包括第一子策略、第二子策略和第三子策略，所述第一子策略、第二子策略和第三子策略包括的平移速度和定位精度均逐渐减小。
[0009]进一步地，所述第一子策略包括的定位精度为分米级，所述第二子策略包括的定位精度为厘米级，所述第三子策略包括的定位精度为毫米级。
[0010]进一步地，所述控制所述机器人进行姿态调整包括：将所述机器人的伺服电机转换为速度模式，通过控制所述机器人的内外轮的速度差，进而调整所述机器人的姿态；所述控制所述机器人进行位置平移包括：将所述机器人的伺服电机转换为位置控制模式，通过
位置定位指令来控制所述机器人在位置平移过程中的速度和位移。
[0011]进一步地，所述方法还包括：确定所述机器人在所有所述直线路径中都完成移动后，判断所述机器人完成移动后的当前位置是否为所述目标位置；如果完成移动后的当前位置不是所述目标位置，则重新计算当前位置到所述目标位置的最优路径。
[0012]进一步地，所述方法还包括：在所述机器人向所述目标位置移动的过程中，当所述机器人遇到非预期障碍物或者出现偏移，控制所述机器人停止移动，重新计算当前位置到所述目标位置的最优路径。
[0013]本专利技术还提供一种全向移动机器人，其特征在于，所述全向移动机器人包括移动控制装置、内外差速轮和驱动装置，所述移动控制装置用于确定机器人的当前位置及目标位置，计算从所述当前位置到所述最终目标位置的最优路径，并将所述最优路径分解为多段直线路径，确定所述机器人在每段所述直线路径中所需的姿态和平移策略，根据所述机器人在每段所述直线路径中所需的姿态和平移策略，在每段所述直线路径中先控制所述机器人进行姿态调整，再控制所述机器人进行位置平移，直至所述机器人到达所述目标位置；所述内外差速轮用于实现姿态调整及位置平移；所述驱动装置包括伺服电机，用于控制所述内外差速轮的移动速度和移动距离。
[0014]进一步地，所述移动控制装置还用于当所述机器人遇到非预期障碍物或者出现偏移，控制所述机器人停止移动，重新计算当前位置到所述目标位置的最优路径。
[0015]进一步地，所述移动控制装置还用于在确定所述机器人在所有所述直线路径中都完成移动后，判断所述机器人完成移动后的当前位置是否为所述目标位置；如果完成移动后的当前位置不是所述目标位置，则重新计算当前位置到所述目标位置的最优路径。
[0016]本专利技术提供的机器人控制方法及全向移动机器人，通过将定位任务分解为多个定位任务，即将计算出的最优路径分解为多个直线路径，控制机器人在每段直线路径中先进性姿态调整，再根据不同移动速度和不同定位精度的位移策略向目标位置移动，使控制算法变得更简单，减少机器人移动过程中动态调整的不稳定因素，提高机器人移动的稳定性。
附图说明
[0017]为了更清楚地说明本专利技术实施例的技术方案，下面将对实施例中所需要使用的附图作简单地介绍，应当理解，以下附图仅示出了本专利技术的某些实施例，因此不应被看作是对范围的限定，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他相关的附图。
[0018]图1为本专利技术一实施例中机器人控制方法流程图；
[0019]图2为本专利技术一实施例中机器人控制方法执行过程示意图；
[0020]图3为本专利技术一实施例中全向移动机器人的结构示意图。
具体实施方式
[0021]有关本专利技术的前述及其他
技术实现思路
、特点与功效，在以下配合参考图式的较佳实施例的详细说明中将可清楚的呈现。通过具体实施方式的说明，当可对本专利技术为达成预期目的所采取的技术手段及功效得以更加深入且具体的了解，然而所附图式仅是提供参考与说明之用，并非用来对本专利技术加以限制，可能未示出某些公知的部分。在各个附图中，相同
的元件采用类似的附图标记来表示。为了清楚起见，附图中的各个部分没有按比例绘制。
[0022]图1是本专利技术一实施例中机器人控制方法流程图，本实施例中提供的机器人控制方法包括以下步骤：
[0023]步骤S01：确定机器人的当前位置及目标位置；
[0024]步骤S02：计算当前位置到目标位置的最优路径；
[0025]具体地，在确定机器人的当前位置以及要到达的目标位置后，将机器人定位的目标位置与当前位置进行比较，通过算法规划出当前位置到目标位置的最优路径，形成机器人从当前位置到目标位置的定位任务。
[0026]步骤S03：将最优路径分解为多段直线路径，并确定机器人在每段直线路径中所需的姿态和平移策略；
[0027]具体地，将定位任务分解成多个定位任务，即将规划出的最优路径分解成多段直线路径，并通过算法分析出机器人在每段直线路径中所需的姿态和平移策略，即机器人在每段直线路径中移动的方向，以及机器人在每段直线路径中所需的包括多种具有不同的平移速度及定位精度的平移子策略。
[0028]具体地，本实施例中的平移子策略包括第一子策略、第二子策略本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种机器人控制方法，其特征在于，包括：确定机器人的当前位置及目标位置；计算从所述当前位置到所述目标位置的最优路径，并将所述最优路径分解为多段直线路径，确定所述机器人在每段所述直线路径中所需的姿态和平移策略；根据所述机器人在每段所述直线路径中所需的姿态和平移策略，在每段所述直线路径中先控制所述机器人进行姿态调整，再控制所述机器人进行位置平移，直至所述机器人到达所述目标位置。2.根据权利要求1所述的机器人移动控制方法，其特征在于，所述机器人在每段所述直线路径中所需的平移策略包括多种具有不同的平移速度及定位精度的子策略；所述在每段所述直线路径中控制所述机器人进行位置平移包括：控制所述机器人依次按照所述多种子策略进行平移和定位，直至到达所述直线路径的终点。3.根据权利要求2所述的机器人移动控制方法，其特征在于，所述子策略包括第一子策略、第二子策略和第三子策略，所述第一子策略、第二子策略和第三子策略包括的平移速度和定位精度均逐渐减小。4.根据权利要求3所述的机器人移动控制方法，其特征在于，所述第一子策略包括的定位精度为分米级，所述第二子策略包括的定位精度为厘米级，所述第三子策略包括的定位精度为毫米级。5.根据权利要求1所述的机器人移动控制方法，其特征在于，所述控制所述机器人进行姿态调整包括：将所述机器人的伺服电机转换为速度模式，通过控制所述机器人的内外轮的速度差，进而调整所述机器人的姿态；所述控制所述机器人进行位置平移包括：将所述机器人的伺服电机转换为位置控制模式，通过位置定位指令来控制所述机器人在位置平移过程中的速度和位移。6.根据权利要求1所述的机器人移动控制方法，其特征在于，所述方法还包括：确定所述机器人在...

【专利技术属性】
技术研发人员：沈岗，关雪丹，
申请(专利权)人：盈合深圳机器人与自动化科技有限公司，
类型：发明
国别省市：