机械臂的运动路径的确定方法和装置制造方法及图纸

本发明专利技术提供一种机械臂的运动路径的确定方法和装置，控制装置从机械臂的抓取部的起始点开始以预设步长，确定当前节点的邻居节点，根据障碍物模型、抓取部与障碍物安全阈值，对当前节点的邻居节点中的无效节点进行过滤，计算过滤后的邻居节点的代价估计，从过滤后的邻居节点中确定代价估计最小的邻居节点为当前节点的下一节点，当下一节点与目标点之间的距离小于预设收敛阈值时，根据起始点、目标点以及起始点和目标点之间所确定所有下一节点确定机械臂的抓取部的运动路径，所述方法能够找到最优的运动路径。

【技术实现步骤摘要】
机械臂的运动路径的确定方法和装置
本专利技术涉及智能装备
，尤其涉及一种机械臂的运动路径的确定方法和装置。
技术介绍
机械臂作为一种自动化机械装置，广泛应用在工业制造、医学治疗、娱乐服务、军事、半导体制造以及太空探索等领域。机械臂的形态多种多样，但它们都有一个共同的特点，就是能够接受指令，精确地定位到三维空间上的某一点进行作业。机械臂由一个位置点移动到另一个位置点所经过的路径称为机械臂的运动路径，机械臂在工作之前需要规划机械臂的运动路径，机械臂的运动路径规划是指：在已知机械臂的模型和周围障碍物模型的情况下，给定起始点和目标点，找到一条合适的路径连接起始点和目标点，并且在这条路径的任何一个中间点上机械臂必须是无碰撞的，碰撞包括机械臂和障碍物的碰撞以及自身轴之间的碰撞。现有的路径规划采用人工势场法，人工势场法的基本思想是将机器人在周围环境中的运动，设计成一种抽象的人造引力场中的运动，目标点对移动机器人产生“引力”，障碍物对移动机器人产生“斥力”，最后通过求合力来控制移动机器人的运动。应用人工势场法规划出来的路径一般是比较平滑并且安全的，但是这种方法容易陷入局部极值点。虽然可以通过增本文档来自技高网...

【技术保护点】
1.一种机械臂的运动路径的确定方法，其特征在于，包括：从机械臂的抓取部的起始点开始以预设步长，确定当前节点的邻居节点；根据障碍物模型、所述抓取部与障碍物安全阈值，对所述当前节点的邻居节点中的无效节点进行过滤，所述无效节点包括碰撞点和超出所述机械臂运动范围的节点；计算过滤后的邻居节点的代价估计，从所述过滤后的邻居节点中确定代价估计最小的邻居节点为所述当前节点的下一节点；当所述下一节点与所述目标点之间的距离小于预设收敛阈值时，根据所述起始点、目标点以及所述起始点和所述目标点之间所确定所有所述下一节点确定所述机械臂的抓取部的运动路径。

【技术特征摘要】
1.一种机械臂的运动路径的确定方法，其特征在于，包括：从机械臂的抓取部的起始点开始以预设步长，确定当前节点的邻居节点；根据障碍物模型、所述抓取部与障碍物安全阈值，对所述当前节点的邻居节点中的无效节点进行过滤，所述无效节点包括碰撞点和超出所述机械臂运动范围的节点；计算过滤后的邻居节点的代价估计，从所述过滤后的邻居节点中确定代价估计最小的邻居节点为所述当前节点的下一节点；当所述下一节点与所述目标点之间的距离小于预设收敛阈值时，根据所述起始点、目标点以及所述起始点和所述目标点之间所确定所有所述下一节点确定所述机械臂的抓取部的运动路径。2.根据权利要求1所述的方法，其特征在于，所述机械臂包括四个轴，所述四个轴中至少包括用于控制所述抓取部高度的轴，从机械臂的抓取部的起始点开始以预设步长，确定当前节点的邻居节点之前，还包括：从所述障碍物模型包括的障碍物中删除无效障碍物，所述无效障碍物为高度小于所述起始点和所述目标点的用于控制所述抓取部高度的轴的位置参数中的较大值的障碍物；删除所述起始点和所述目标点的用于控制所述抓取部高度的轴的位置参数。3.根据权利要求1或2所述的方法，其特征在于，所述计算过滤后的邻居节点的代价估计，包括：当没有存储所述邻居节点的信息时，根据以下公式计算所述邻居节点的代价估计：f(θ')＝g(θ')+h(θ')；g(θ')＝g(θ)+dis(θ,θ')；h(θ')＝dis(θ',θg)；其中，f(θ')表示从所述起始点经由所述邻居节点θ'到所述目标点θg的代价估计，g(θ')表示从所述起始点到所述邻居节点θ'的实际代价，g(θ)表示从所述起始点到所述当前节点θ的实际代价，dis(θ,θ')表示从所述当前节点θ到所述邻居节点θ'的距离，h(θ')表示从所述邻居节点θ'到所述目标点θg的最佳路径的代价估计。4.根据权利要求1或2所述的方法，其特征在于，所述计算过滤后的邻居节点的代价估计，包括：当存储了所述邻居节点的信息时，根据预设的更新条件判断是否更新所述邻居节点的信息，其中，所述预设的更新条件为：g(θ)+dis(θ,θ')≥g(θ')；其中，g(θ')表示从所述起始点到所述邻居节点θ'的实际代价，g(θ)表示从所述起始点到所述当前节点θ的实际代价，dis(θ,θ')表示所述当前节点到所述邻居节点θ'的距离，g(θ')和g(θ)为存储的值；当所述预设的更新条件成立时，确定不更新所述邻居节点θ'的信息；当所述预设的更新条件不成立时，确定更新所述邻居节点θ'的信息，并根据以下公式更新所述邻居节点θ'的f(θ')和g(θ')值：f(θ')＝g(θ')+h(θ')；g(θ')＝g(θ)+dis(θ,θ')；其中，f(θ')表示从所述起始点经由所述邻居节点θ'到所述目标点的代价估计。5.根据权利要求1所述的方法，其特征在于，从机械臂的抓取部的起始点开始以预设步长，确定当前节点的邻居节点之前，还包括：根据所述机械臂的运动范围，以及所述抓取部与障碍物的距离，判断所述起始点和所述目标点的位置是否合理。6.根据权利要求5所述的方法，其特征在于，所述根据所述机械臂的运动范围，以及所述抓取部与障碍物的距离，判断所述起始点和所述目标点的位置是否合理，包括：判断所述起始点和所述目标点是否满足预设条件，所述预设条件包括：所述起始点和所述目标点位于所述机械臂的运动范围内，所述抓取部位于所述起始点时所述抓取部与所述障碍物模型中的所有障碍物的距离均大于所述抓取部与障碍物安全阈值，以及抓取部位于所述目标点时所述抓取部与所述障碍物模型中的所有障碍物的距离均大于所述抓取部与障碍物安全阈值；当所述起始点和所述目标点满足所述预设条件时，判断所述起始点和所述目标点的距离是否大于或等于所述预设收敛阈值；当所述起始点和所述目标点的距离大于或等于所述预设收敛阈值时，确定所述起始点和所述目标点的位置合理；当所述起始点和所述目标点的距离小于所述预设收敛阈值时，返回所述起始点和所述目标点的位置不合理；当所述起始点和所述目标点不满足所述预设条件时，返回所述起始点和所述目标点的位置不合理。7.根据权利要求2所述的方法，其特征在于，根据所述起始点、目标点以及所述起始点和所述目标点之间所确定所有所述下一节点确定所述机械臂的抓取部的运动路径之后，还包括：为所述动路径中的各节点的位置参数增加用于控制所述抓取部高度的轴的位置参数，其中，增加的用于控制所述抓取部高度的轴的位置参数为所述起始点和所述目标点的用于控制所述抓取部高度的轴的位置参数中的较大值。8.一种机械臂的运动路径的确定装置，其特征在于，包括：确定模块，用于从机...

【专利技术属性】
技术研发人员：杨开红，
申请(专利权)人：广州视源电子科技股份有限公司，
类型：发明
国别省市：广东,44