CN114227655A - 确定规划路径的方法、装置、scara机器人及介质 - Google Patents

确定规划路径的方法、装置、scara机器人及介质 Download PDF

Info

Publication number
CN114227655A
CN114227655A CN202111658542.4A CN202111658542A CN114227655A CN 114227655 A CN114227655 A CN 114227655A CN 202111658542 A CN202111658542 A CN 202111658542A CN 114227655 A CN114227655 A CN 114227655A
Authority
CN
China
Prior art keywords
joint
interpolation
interpolation points
angle
point
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202111658542.4A
Other languages
English (en)
Other versions
CN114227655B (zh
Inventor
肖卓
尚波
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shenzhen Invt Electric Co Ltd
Original Assignee
Shenzhen Invt Electric Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Shenzhen Invt Electric Co Ltd filed Critical Shenzhen Invt Electric Co Ltd
Priority to CN202111658542.4A priority Critical patent/CN114227655B/zh
Publication of CN114227655A publication Critical patent/CN114227655A/zh
Application granted granted Critical
Publication of CN114227655B publication Critical patent/CN114227655B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/02—Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type
    • B25J9/04—Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type by rotating at least one arm, excluding the head movement itself, e.g. cylindrical coordinate type or polar coordinate type
    • B25J9/041—Cylindrical coordinate type
    • B25J9/042—Cylindrical coordinate type comprising an articulated arm
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1602—Programme controls characterised by the control system, structure, architecture
    • B25J9/161—Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1628—Programme controls characterised by the control loop
    • B25J9/1633—Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1661—Programme controls characterised by programming, planning systems for manipulators characterised by task planning, object-oriented languages
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • Artificial Intelligence (AREA)
  • Evolutionary Computation (AREA)
  • Fuzzy Systems (AREA)
  • Mathematical Physics (AREA)
  • Software Systems (AREA)
  • Manipulator (AREA)
  • Numerical Control (AREA)

Abstract

本申请提供确定一种规划路径的方法、装置、SCARA机器人及介质。其中，该方法包括：获取SCARA机器人待规划路径的起始点、待规划路径的终止点、第一端的上升高度和下降高度；确定多个关节中各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点；确定第一端的上升高度对应的P个插值点和第一端的下降高度对应的Q个插值点；根据各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点、P个插值点和Q个插值点确定第一端的移动的规划路径。本申请利用多个插值点规划的移动路径相对与现有的直线路径比较平滑，避免SCARA机器人需要大幅度的变换方向而导致的停顿，从而可以提高SCARA机器人的作业效率。

Description

确定规划路径的方法、装置、SCARA机器人及介质
技术领域
本申请属于运动控制技术领域，尤其涉及确定规划路径的方法、装置、SCARA机器人及介质。
背景技术
随着我国机器人行业的发展，不同领域可以采用不同类型的机器人进行作业，例如，选择顺应性装配机器手臂(Selective Compliance Assembly Robot Arm，SCARA)机器人，可以进行点胶或装配等。
在SCARA机器人进行作业时，通常需要避开障碍物进行作业，相关技术中，通常SCARA机器人的作业过程中的移动路径是由多条直线组成的，该机器人在移动到两条直线的拐点处时，通常需要停下来从一条直线的移动方向转换到另一条直线移动方向，这样会导致该机器人需要停顿，从而会导致该机器人的作业效率较差。
发明内容
本申请实施例提供了确定规划路径的方法、装置、SCARA机器人及介质，利用多个插值点规划第一端的移动路径，避免SCARA机器人需要大幅度的变换方向而导致的停顿，从而可以提高SCARA机器人的作业效率。
为了实现上述目的，第一方面，本申请实施例提供了一种确定规划路径的方法，该方法应用于SCARA机器人，该SCARA机器人包括多个关节，多个关节包括第一关节，第一关节用于控制机器人的第一端升降，该方法包括：
获取SCARA机器人待规划路径的起始点、待规划路径的终止点、第一端的上升高度和下降高度，起始点与多个关节的关节角度一一对应，终止点与多个关节的关节角度一一对应；
确定多个关节中各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点；
确定第一端的上升高度对应的P个插值点和第一端的下降高度对应的Q个插值点，P+Q小于或等于N，N、P和Q为正整数；
根据各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点、P个插值点和Q个插值点确定起始点到终止点之间的第一端的移动的规划路径。
上述方案中，机器人可以根据各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，以及SCARA机器人的第一端的上升高度对应的P个插值点和第一端的下降高度对应的Q个插值点，规划第一端的移动的规划路径，利用多个插值点规划的移动路径相对与直线路径比较平滑，避免SCARA机器人需要大幅度的变换方向而导致的停顿，从而可以提高SCARA机器人的作业效率。
可选地，确定多个关节中各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，包括：
根据多个关节中各个关节对应的起始点的关节角度与终止点的关节角度，确定各个关节对应的角度变化量；
根据各个关节对应的预设的第一运动参数，确定各个关节移动各自的角度变化量所需要的运动总时间；
在多个关节中将最大总时间对应的关节确定为第二关节；
根据预设的第一运动参数，确定第二关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点；
根据第二关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，确定多个关节中除第二关节外的其他各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点。
上述方案中，根据各个关节对应的预设的第一运动参数、各个关节对应的角度变化量，确定各个关节移动各自的角度变化量所需要的运动总时间，是为了将各个关节移动各自的角度变化量所需要的运动总时间进行比较，获取最大总时间对应的关节为第二关节，也就是主运动关节，由于主运动关节能够表示SCARA机器人的大致运动位置，因此，可以先利用预设的第一运动参数，对主运动关节对应的起始点的关节角度与终止点的关节角度之间的角度进行插补，得到N个插值点，并利用主运动关节对应的起始点的关节角度与终止点的关节角度之间N个插值点，确定除第二关节外的其他各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点。
可选地，根据第二关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，确定多个关节中除第二关节外的其他各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，包括：
根据除第二关节外的其他各个关节对应的起始点的关节角度、第二关节对应的起始点的关节角度、第二关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点、第二关节对应的角度变化量和除第二关节外的其他各个关节对应的角度变化量，确定除第二关节外的其他各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点。
可选地，第一端的上升高度和下降高度相等时，P等于Q。
上述方案相对于上升高度和下降高度不相等的方案来说，设计更加简单。
可选地，确定第一端的上升高度对应的P个插值点和第一端的下降高度对应的Q个插值点，包括：
根据预设的第二运动参数，确定第一端的上升高度对应的P个插值点和第一端的下降高度对应的Q个插值点。
可选地，在根据预设的第二运动参数，确定第一端的上升高度对应的P个插值点和第一端的下降高度对应的Q个插值点之前，方法还包括：
若第一端的上升高度对应的插值点数量与第一端下降高度对应的插值点数量之和大于N，则调整预设的第三运动参数；
将调整后的第三运动参数确定为第二运动参数。
上述方案中，预设的第三运动参数可以确定第一端的上升高度对应的插值点数量与第一端下降高度对应的插值点数量，调整预设的第三运动参数，是为了使P+Q小于或等于N，这样得到的第一端的上升高度对应的P个插值点和第一端的下降高度对应的Q个插值点，才可以与起始点位置处第一关节对应的关节角度与终止点位置处的关节角度之间的N个插值点进行求和。
可选地，根据各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点、P个插值点和Q个插值点确定起始点到终止点之间的第一端的移动的规划路径，包括：
根据P个插值点和Q个插值点，确定第一端在上升高度与下降高度对应的N个插值点；
将第一端在上升高度与下降高度对应的N个插值点和第一关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点一一对应求和，更新第一关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点；
根据更新的第一关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点和多个关节中除第一关节外的其他各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，确定起始点到终止点之间的第一端的移动的规划路径。
上述方案中，由于第一端的上升高度与下降高度是由第一关节来旋转控制的，因此，可以将第一端在上升高度与下降高度对应的N个插值点与第一关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点一一对应求和，从而更新第一关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，进而再与除第一关节外的其他各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，共同确定SCARA机器人的第一端的运行路径，而不是盲目地规划路径，造成SCARA机器人的第一端可能碰撞障碍物的问题。
可选地，根据P个插值点和Q个插值点，确定第一端在上升高度与下降高度对应的N个插值点，包括：
若P+Q小于N，将P个插值点与Q个插值点按照第一排序规则，确定P+Q个插值点；
在P+Q个插值点中插补N-P-Q个第一值，确定第一端在上升高度与下降高度对应的N个插值点；
若P+Q等于N，将P个插值点与Q个插值点按照第一顺序规则，确定第一端在上升高度与下降高度对应的N个插值点。
可选地，第一值为0度。
上述方案中，P个插值点和Q个插值点分别为SCARA机器人第一端的上升高度和下降高度对应的插值点，SCARA机器人第一端的升降是通过第一关节关节角度来控制的，可以将第一端的上升高度和下降高度对应的N个插值点与点对点运动中第一关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点求和，因此，需要确保由第一端的上升高度和下降高度对应的插值点的数量与N值相等。
第二方面，本申请实施例提供了一种确定规划路径的装置，该装置包括：
获取单元，用于获取装置待规划路径的起始点、待规划路径的终止点、第一端的上升高度和下降高度，起始点与多个关节的关节角度一一对应，终止点与多个关节的关节角度一一对应；
确定单元，用于多个关节中各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点；
所述确定单元，还用于确定第一端的上升高度对应的P个插值点和第一端的下降高度对应的Q个插值点，P+Q小于或等于N，N，P和Q为正整数；
所述确定单元，还用于根据各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点、P个插值点和Q个插值点确定起始点到终止点之间的第一端的移动的规划路径。
可选地，所述确定单元具体用于，根据多个关节中各个关节对应的起始点的关节角度与终止点的关节角度，确定各个关节对应的角度变化量；
根据各个关节对应的预设的第一运动参数，确定各个关节移动各自的角度变化量所需要的运动总时间；
在多个关节中将最大总时间对应的关节确定为第二关节；
根据预设的第一运动参数，确定第二关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点；
根据第二关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，确定多个关节中除第二关节外的其他各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点。
可选地，所述确定单元还具体用于，根据除第二关节外的其他各个关节对应的起始点的关节角度、第二关节对应的起始点的关节角度、第二关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点、第二关节对应的角度变化量和除第二关节外的其他各个关节对应的角度变化量，确定除第二关节外的其他各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点。
可选地，第一端的上升高度和下降高度相等时，P等于Q。
可选地，该装置还包括：处理单元用于根据预设的第二运动参数，确定第一端的上升高度对应的P个插值点和第一端的下降高度对应的Q个插值点。
可选地，所述处理单元具体还用于，若第一端的上升高度对应的插值点数量与第一端下降高度对应的插值点数量之和大于N，则调整预设的第三运动参数；
将调整后的第三运动参数确定为第二运动参数。
可选地，所述确定单元还用于，根据P个插值点和Q个插值点，确定第一端在上升高度与下降高度对应的N个插值点。
可选地，该装置还包括：更新单元用于将第一端在上升高度与下降高度对应的N个插值点和第一关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点一一对应求和，更新第一关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点。
可选地，所述确定单元还用于，根据更新的第一关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点和多个关节中除第一关节外的其他各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，确定起始点到终止点之间的第一端的移动的规划路径。
可选地，所述确定单元具体还用于，若P+Q小于N，将P个插值点与Q个插值点按照第一排序规则，确定P+Q个插值点；
在P+Q个插值点中插补N-P-Q个第一值，确定第一端在上升高度与下降高度对应的N个插值点；
若P+Q等于N，将P个插值点与Q个插值点按照第一顺序规则，确定第一端在上升高度与下降高度对应的N个插值点。
第三方面，本申请实施例提供一种SCARA机器人，包括处理器，处理器与存储器耦合，处理器用于执行存储器中存储的计算机程序或指令时，以实现上述第一方面或第一方面的任一实施方式的方法。
第四方面，本申请实施例提供一种介质，该介质上存储有计算机程序，计算机程序被处理器执行时，以实现上述第一方面或第一方面的任一实施方式的方法。
本申请实施例与现有技术相比存在的有益效果是：由于本申请根据各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，以及SCARA机器人第一端的上升高度对应的P个插值点和第一端的下降高度对应的Q个插值点，规划第一端的移动的规划路径，利用多个插值点规划的移动路径相对与直线路径比较平滑，避免SCARA机器人需要大幅度的变换方向而导致的停顿，从而可以提高SCARA机器人的作业效率。
附图说明
为了更清楚地说明本申请实施例中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本申请的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
图1是本申请一实施例提供的一种SCARA机器人的结构示意图；
图2是本申请一实施例提供的一种相关技术中SCARA机器人的末端避障的移动路径图；
图3是本申请一实施例提供的一种确定规划路径的方法的流程示意图；
图4是本申请一实施例提供的一种确定规划路径的方法中的7段S型速度规划的速度示意图；
图5是本申请一实施例提供的一种确定规划路径的方法中的7段S型速度规划的加速度示意图；
图6是本申请一实施例提供的一种相关技术的移动路径与本方案的移动路径的对比示意图；
图7是本申请一实施例提供的一种确定规划路径的装置的示意图；
图8是本申请一实施例提供的一种SCARA机器人的结构示意图。
具体实施方式
下面将结合本申请实施例中的，对本申请实施例中的技术方案进行详细说明。
应当理解，本申请实施例中的方式、情况、类别以及实施例的划分只是为了方便描述，不对本申请构成任何限定，各种方式、类别、情况以及实施例中的特征在不相矛盾的情况下可以相互结合。
随着我国机器人行业的发展，不同领域可以采用不同类型的机器人进行作业，例如，选择顺应性装配机器手臂(Selective Compliance Assembly Robot Arm，SCARA)机器人，可以进行点胶或装配等。
在SCARA机器人进行作业时，通常该机器人需要避开障碍物进行作业。相关技术中，该机器人在作业过程中的移动路径是由多条直线组成的，机器人在移动到两条直线的拐点处时，通常需要停下来从一条直线的移动方向换到另一条直线的移动方向，这样会导致SCARA机器人需要停顿，从而会导致该机器人的作业效率较差。
图1是本申请提供的一种SCARA机器人的示意图，举例给出了包括四个关节的SCARA机器人的具体结构，四个关节具体为第一关节、第二关节、第三关节和第四关节。其中，第一关节的旋转用来控制SCARA机器人的第一端的升降，第二关节的旋转用来控制第一端e的水平面上的具体位置，SCARA机器人的第一端e的具体位置由四个关节的关节角度确定。SCARA机器人的四个关节对应的关节角度均为0时，该机器人所呈现的位置如图1所示。图1所示的SCARA机器人的第一端在避障时，第一端会沿着多条直线移动，在两直线拐点处，第一段需要停下来从一条直线的方向切换到另一条直线的方向，例如图2中的a、b处，SCARA机器人需要在a、b处停顿，这样会导致机器人的作业效率较差，其中，第一端可以是机器人的末端。
应理解地，图1只是举例说明了某一种SCARA机器人，SCARA机器人包括四个关节，当然，该机器人也可以包括五个关节，其中有一个关节用于控制机器人第一端的升降等，图2只是举例说明了一种SCARA机器人的末端的移动路径，但是本申请的方案并不限定于图2所示的移动路径。
基于上述问题，本申请提出了确定规划路径的方法、装置、SCARA机器人及介质，首先获取SCARA机器人待规划路径的起始点、待规划路径的终止点、第一端的上升高度和下降高度；再确定多个关节中各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点；确定第一端的上升高度对应的P个插值点和第一端的下降高度对应的Q个插值点，P+Q小于或等于N，N、P和Q为正整数；最后根据各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点、P个插值点和Q个插值点确定起始点到终止点之间的第一端的移动的规划路径，本申请中，SCARA机器人可以根据各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，以及SCARA机器人第一端的上升高度对应的P个插值点和第一端的下降高度对应的Q个插值点，规划第一端的移动的规划路径，利用多个插值点规划的移动路径相对与直线路径比较平滑，避免SCARA机器人需要大幅度的变换方向而导致的停顿，从而可以提高SCARA机器人的作业效率。
下面以具体地实施例对本申请的技术方案进行详细说明，下面这几个具体的实施例可以相互结合，对于相同或相似的概念或过程可能在某些实施例不再赘述。
图3为本申请实施例提供的一种确定规划路径的方法的流程示意图，如图3所示，该方法应用于SCARA机器人，该机器人包括多个关节，多个关节包括第一关节，第一关节用于控制SCARA机器人的第一端升降，该方法包括如下步骤：
S310，SCARA机器人获取SCARA机器人待规划路径的起始点、待规划路径的终止点、第一端的上升高度和下降高度，起始点与多个关节的关节角度一一对应，终止点与多个关节的关节角度一一对应。
在对SCARA机器人的第一端的避障路径进行规划之前，首先需要获取该机器人待规划路径的起始点、待规划路径的终止点，第一端避开障碍物的上升高度和下降高度。该机器人包括多个关节，且该机器人的第一端的具体位置均由多个关节的关节角度确定，例如，第一端在起始点时，起始点与多个关节的关节角度一一对应，第一端在终止点时，终止点与多个关节的关节角度一一对应。
可选地，在步骤S310中，SCARA机器人的关节数量可以是预设的。
例如，SCARA机器人可以是包括四个关节的SCARA机器人。
可选地，在步骤S310中，SCARA机器人可以包括四个关节，起始点与四个关节的关节角度一一对应，终止点与四个关节的关节角度一一对应。
例如，起始点P1(a1,a2,a3,a4)，终止点P2(b1,b2,b3,b4)。其中，起始点P1(a1,a2,a3,a4)的含义为：第一关节转动的角度为a1，第二关节转动的角度为a2，第三关节转动的角度为a3，第四关节转动的角度为a4，得到第一端的起始点；终止点P2(b1,b2,b3,b4)的含义为：第一关节转动的角度为b1，第二关节转动的角度为b2，第三关节转动的角度为b3，第四关节转动的角度为b4，得到第一端的终止点。
S320，SCARA机器人确定多个关节中各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点。
可选地，步骤S320，包括：根据多个关节中各个关节对应的起始点的关节角度与终止点的关节角度，SCARA机器人确定各个关节对应的角度变化量；
根据各个关节对应的预设的第一运动参数，SCARA机器人确定各个关节移动各自的角度变化量所需要的运动总时间；
SCARA机器人在多个关节中将最大总时间对应的关节确定为第二关节；
根据预设的第一运动参数，SCARA机器人确定第二关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点；
根据第二关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，SCARA机器人确定多个关节中除第二关节外的其他各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点。
上述方案中，根据各个关节对应的预设的第一运动参数、各个关节对应的角度变化量，确定各个关节移动各自的角度变化量所需要的运动总时间，是为了将各个关节移动各自的角度变化量所需要的运动总时间进行比较，获取最大总时间对应的关节为第二关节，也就是主运动关节，由于主运动关节能够表示SCARA机器人的大致运动位置，因此，可以先利用预设的第一运动参数，对主运动关节对应的起始点的关节角度与终止点的关节角度之间的角度进行插补，得到N个插值点，并利用主运动关节对应的起始点的关节角度与终止点的关节角度之间N个插值点，确定除第二关节外的其他各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点。
可选地，根据第二关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，SCARA机器人确定多个关节中除第二关节外的其他各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，具体包括：
根据除第二关节外的其他各个关节对应的起始点的关节角度、第二关节对应的起始点的关节角度、第二关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点、第二关节对应的角度变化量和除第二关节外的其他各个关节对应的角度变化量，SCARA机器人确定除第二关节外的其他各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点。
可选地，根据第二关节对应的第i个插值点与第二关节对应的起始点的关节角度，SCARA机器人确定第i角度变化量；
根据第i角度变化量与第二关节对应的角度变化量，SCARA机器人确定比值；
根据比值、除第二关节外的其他各个关节对应的角度变化量和除第二关节外的其他各个关节对应的起始点的关节角度，SCARA机器人确定除第二关节外的其他各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，其中，i为正整数。
例如，根据ax,i＝ax+((am,i-am)/Sm)*Sx确定多个关节中除第二关节外的其他各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点。其中，ax为除第二关节外其他任意一个关节对应的起始点的关节角度，Sm为第二关节m对应的角度变化量，Sx为除第二关节外其他任意一个关节对应的角度变化量，ax,i为除第二关节外其他任意一个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，am,i为第二关节m对应的第i个插值点。
针对上述方案，本申请给出了如下一种实施例：
一种SCARA机器人，该机器人包括四个关节，第一关节、第二关节、第三关节和第四关节。第一关节对应的起始点的关节角度为a1，第一关节对应的终止点的关节角度为b1；第二关节对应的起始点的关节角度为a2，第二关节对应的终止点的关节角度为b2；第三关节对应的起始点的关节角度为a3，第三关节对应的终止点的关节角度为b3；第四关节对应的起始点的关节角度为a4，第四关节对应的终止点的关节角度为b4；预设的第一运动参数为：各个关节对应的角度变化量的加加速度J1、最大加速度a1max、初始速度ve、终止速度vs和最大速度v1max。
根据四个关节对应的起始点的关节角度与终止点的关节角度，四个关节对应的角度变化量分别为：S1＝b1-a1，S2＝b2-a2，S3＝b3-a3，S4＝b4-a4；
对上述四个关节对应的角度变化量分别采用7段S型的速度规划，如图4给出了7段S型速度规划的速度的示意图，具体表示在一定时间内关节对应的角度变化量，例如从第1段到第2段再到第3段关节旋转的速度越来越快，说明关节对应的角度变化量越来越大，第4段为均速，其中i的值为1，如图5给出了7段S型速度规划的加速度的示意图，具体表示在一定时间内关节对应的关节角度的变化量，例如从第1段到第2段再到第3段关节旋转的加速度先增大后保持不变最后减小，说明关节对应的旋转的速度变化先增大后保持不变最后减小，第4段为均速，说明关节旋转的加速度为0，其中i的值为1；
针对第一关节：起始点的关节角度a1，终止点的关节角度b1，在对第一关节的角度变化量S1采用7段S型的速度规划时，7段中每一段的时间分别为：T1＝a1max/J1，T2＝(v1max-ve)/a1max-a1max/J1，T3＝a1max/J1，T4＝(S1-Sa-Sb)/v1max，T5＝a1max/J1，T6＝((v1max-ve)/-a1max)-(-a1max/J1)和T7＝a1max/J1；
其中，Sa＝ve(2T1+T2)+1/2J1T1(2T1 2+3T1T2+T2 2)，Sa为7段角度变化量中的第1段、第2段和第3段的角度变化量之和；
Sb＝vmax(2T5+T6)-1/2J1T5(2T5 2+3T5T6+T6 2)，Sb为7段角度变化量中的第5段、第6段和第7段的角度变化量之和；
则，第一关节移动S1角度变化量所需要的运动总时间为ta＝T1+T2+T3+T4+T5+T6+T7。
针对第二关节：起始点的关节角度a2、终止点的关节角度b2，在对第二关节的角度变化量S2采用7段S型的速度规划时，7段中每一段的时间分别为：T1＝a1max/J1，T2＝(v1max-ve)/a1max-a1max/J1，T3＝a1max/J1，T4＝(S2-Sa-Sb)/v1max，T5＝a1max/J1，T6＝((v1max-ve)/-a1max)-(-a1max/J1)和T7＝a1max/J1；
其中，Sa＝ve(2T1+T2)+1/2J1T1(2T1 2+3T1T2+T2 2)，Sa为7段运动位移中的第1段、第2段和第3段的运动位移之和；
Sb＝vmax(2T5+T6)-1/2J1T5(2T5 2+3T5T6+T6 2)，Sb为7段角度变化量中的第5段、第6段和第7段的角度变化量之和；
则，第二关节移动S2角度变化量所需要的运动总时间为tb＝T1+T2+T3+T4+T5+T6+T7。
针对第三关节：起始点的关节角度a3、终止点的关节角度b3，在对第三关节的角度变化量S3采用7段S型的速度规划时，7段中每一段的时间分别为：T1＝a1max/J1，T2＝(v1max-ve)/a1max-a1max/J1，T3＝a1max/J1，T4＝(S3-Sa-Sb)/v1max，T5＝a1max/J1，T6＝((v1max-ve)/-a1max)-(-a1max/J1)和T7＝a1max/J1；
其中，Sa＝ve(2T1+T2)+1/2J1T1(2T1 2+3T1T2+T2 2)，Sa为7段角度变化量中的第1段、第2段和第3段的角度变化量之和；
Sb＝vmax(2T5+T6)-1/2J1T5(2T5 2+3T5T6+T6 2)，Sb为7段角度变化量中的第5段、第6段和第7段的角度变化量之和；
则，第三关节移动S3角度变化量所需要的运动总时间为tc＝T1+T2+T3+T4+T5+T6+T7。
针对第四关节：起始点的关节角度a4、终止点的关节角度b4，在第四关节的角度变化量S4采用7段S型速度规划时，7段中每一段的时间分别为：T1＝a1max/J1，T2＝(v1max-ve)/a1max-a1max/J1，T3＝a1max/J1，T4＝(S4-Sa-Sb)/v1max，T5＝a1max/J1，T6＝((v1max-ve)/-a1max)-(-a1max/J1)和T7＝a1max/J1；
其中，Sa＝ve(2T1+T2)+1/2J1T1(2T1 2+3T1T2+T2 2)，Sa为7段角度变化量中的第1段、第2段和第3段的角度变化量之和；
Sb＝vmax(2T5+T6)-1/2J1T5(2T5 2+3T5T6+T6 2)，Sb为7段角度变化量中的第5段、第6段和第7段的角度变化量之和；
则，第四关节移动S4角度变化量所需要的运动总时间为td＝T1+T2+T3+T4+T5+T6+T7。
通过比较ta，tb，tc，td四者的大小，将其中最大总时间对应的关节确定为第二关节m。
对于第二关节m对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，可以分为7段来得到N个插值点am,i，其中，i从1到N，具体的过程如下：
已知：预设的第一运动参数：第二关节的起始点的关节角度a1，终止点的关节角度b1，角度变化量S1＝b1-a1，插值周期Ts，第二关节对应的角度变化量S1的加加速度J1、最大加速度a1max、初始速度ve、终止速度vs和最大速度v1max，第二关节对应的角度变化量S1所对应的7段的插值点数分别为N1＝T1/Ts，N2＝T2/Ts，N3＝T3/Ts，N4＝T4/Ts，N5＝T5/Ts，N6＝T6/Ts和N7＝T7/Ts，7段S型的速度规划的对应的角度变化量的公式：
Figure BDA0003446709550000141
其中，τi为7段S型角度变化量所对应的时间，Sm,i为第i个插值点与a1的角度变化量。
根据am,i＝a2+S2*(Sm,i/L总长度)确定第二关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，其中，对于第二关节L总长度为S2。
例如，根据第二关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点数，以及第二关节对应的角度变化量S1所对应的7段的插值点数，可以得出第i个插值点具体在哪一段，如N为25，N1为4，N2为2，N3为3，N4为7，N5为3，N6为2，N7为4时，第1个插值点在7段中的第1段，Sm,1可以根据Sm,i的第1个公式求得，τ1为τ1＝Ts*1；第21个插值点在7段中的第6段，Sm,20可以根据Sm,i的第6个公式求得，τ21为τ21＝Ts*21。
基于上述的原理，可以确定第二关节m对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，具体为am,1,am,2,...,am,N。
针对除第二关节外的其他各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，具体的求得过程如下：
已知第二关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点am,i，以及ax,i＝ax+((am,i-am)/Sm)*Sx确定多个关节中除第二关节外的其他各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点。其中，ax为除第二关节外其他任意一个关节对应的起始点的关节角度，Sm为第二关节对应的角度变化量，Sx为除第二关节外其他任意一个关节对应的角度变化量，ax,i为除第二关节外其他任意一个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点。
例如，第一关节对应的起始点的关节角度与终止点的关节角度之间的25个插值点为：第1个插值点为a1,1＝a1+((am,1-am)/Sm)*S1；第13个插值点为a1,13＝a1+((am,13-am)/Sm)*S1；第25个插值点为a1,25＝a1+((am,25-am)/Sm)*S1，最终，确定所有插值点a1,1,a1,2,...,a1,N；
第三关节对应的起始点的关节角度与终止点的关节角度之间的25个插值点为：第1个插值点为a3,1＝a3+((am,1-am)/Sm)*S3；第13个插值点为a3,13＝a3+((am,13-am)/Sm)*S3；第25个插值点为a3,25＝a3+((am,25-am)/Sm)*S3，最终，确定所有插值点a3,1,a3,2,...,a3,N；
第四关节对应的起始点的关节角度与终止点的关节角度之间的25个插值点为：第1个插值点为a4,1＝a4+((am,1-am)/Sm)*S4；第13个插值点为a4,13＝a4+((am,13-am)/Sm)*S4；第25个插值点为a4,25＝a4+((am,25-am)/Sm)*S4，最终，确定所有插值点a4,1,a4,2,...,a4,N。
针对上述方案，本申请给出了如下又一种实施例：
一种SCARA机器人，该机器人包括五个关节，第一关节、第二关节、第三关节、第四关节和第五关节。第一关节对应的起始点的关节角度为a1，第一关节对应的终止点的关节角度为b1；第二关节对应的起始点的关节角度为a2，第二关节对应的终止点的关节角度为b2；第三关节对应的起始点的关节角度为a3，第三关节对应的终止点的关节角度为b3；第四关节对应的起始点的关节角度为a4，第四关节对应的终止点的关节角度为b4；第五关节对应的起始点的关节角度为a5，第五关节对应的终止点的关节角度为b5；预设的第一运动参数为：各个关节对应的角度变化量的加加速度J1、最大加速度a1max、初始速度ve、终止速度vs和最大速度v1max。
根据五个关节对应的起始点的关节角度与终止点的关节角度，五个关节对应的角度变化量分别为：S1＝b1-a1，S2＝b2-a2，S3＝b3-a3，S4＝b4-a4，S5＝b5-a5；
对上述五个关节对应的角度变化量分别采用7段S型的速度规划：
针对第一关节：起始点的关节角度a1，终止点的关节角度b1，在对第一关节的角度变化量S1采用7段S型的速度规划时，7段中每一段的时间分别为：T1＝a1max/J1，T2＝(v1max-ve)/a1max-a1max/J1，T3＝a1max/J1，T1,4＝(S1-Sa-Sb)/v1max，T5＝a1max/J1，T6＝((v1max-ve)/-a1max)-(-a1max/J1)和T7＝a1max/J1；
其中，Sa＝ve(2T1+T2)+1/2J1T1(2T1 2+3T1T2+T2 2)，Sa为7段角度变化量中的第1段、第2段和第3段的角度变化量之和；
Sb＝vmax(2T5+T6)-1/2J1T5(2T5 2+3T5T6+T6 2)，Sb为7段角度变化量中的第5段、第6段和第7段的角度变化量之和。
针对第二关节：起始点的关节角度a2、终止点的关节角度b2，在对第二关节的角度变化量S2采用7段S型的速度规划时，7段中每一段的时间分别为：T1＝a1max/J1，T2＝(v1max-ve)/a1max-a1max/J1，T3＝a1max/J1，T2,4＝(S2-Sa-Sb)/v1max，T5＝a1max/J1，T6＝((v1max-ve)/-a1max)-(-a1max/J1)和T7＝a1max/J1；
其中，Sa＝ve(2T1+T2)+1/2J1T1(2T1 2+3T1T2+T2 2)，Sa为7段运动位移中的第1段、第2段和第3段的运动位移之和；
Sb＝vmax(2T5+T6)-1/2J1T5(2T5 2+3T5T6+T6 2)，Sb为7段角度变化量中的第5段、第6段和第7段的角度变化量之和。
针对第三关节：起始点的关节角度a3、终止点的关节角度b3，在对第三关节的角度变化量S3采用7段S型的速度规划时，7段中每一段的时间分别为：T1＝a1max/J1，T2＝(v1max-ve)/a1max-a1max/J1，T3＝a1max/J1，T3,4＝(S3-Sa-Sb)/v1max，T5＝a1max/J1，T6＝((v1max-ve)/-a1max)-(-a1max/J1)和T7＝a1max/J1；
其中，Sa＝ve(2T1+T2)+1/2J1T1(2T1 2+3T1T2+T2 2)，Sa为7段角度变化量中的第1段、第2段和第3段的角度变化量之和；
Sb＝vmax(2T5+T6)-1/2J1T5(2T5 2+3T5T6+T6 2)，Sb为7段角度变化量中的第5段、第6段和第7段的角度变化量之和。
针对第四关节：起始点的关节角度a4、终止点的关节角度b4，在第四关节的角度变化量S4采用7段S型速度规划时，7段中每一段的时间分别为：T1＝a1max/J1，T2＝(v1max-ve)/a1max-a1max/J1，T3＝a1max/J1，T4,4＝(S4-Sa-Sb)/v1max，T5＝a1max/J1，T6＝((v1max-ve)/-a1max)-(-a1max/J1)和T7＝a1max/J1；
其中，Sa＝ve(2T1+T2)+1/2J1T1(2T1 2+3T1T2+T2 2)，Sa为7段角度变化量中的第1段、第2段和第3段的角度变化量之和；
Sb＝vmax(2T5+T6)-1/2J1T5(2T5 2+3T5T6+T6 2)，Sb为7段角度变化量中的第5段、第6段和第7段的角度变化量之和。
针对第五关节：起始点的关节角度a5、终止点的关节角度b5，在第五关节的角度变化量S5采用7段S型速度规划时，7段中每一段的时间分别为：T1＝a1max/J1，T2＝(v1max-ve)/a1max-a1max/J1，T3＝a1max/J1，T5,4＝(S4-Sa-Sb)/v1max，T5＝a1max/J1，T6＝((v1max-ve)/-a1max)-(-a1max/J1)和T7＝a1max/J1；
其中，Sa＝ve(2T1+T2)+1/2J1T1(2T1 2+3T1T2+T2 2)，Sa为7段角度变化量中的第1段、第2段和第3段的角度变化量之和；
Sb＝vmax(2T5+T6)-1/2J1T5(2T5 2+3T5T6+T6 2)，Sb为7段角度变化量中的第5段、第6段和第7段的角度变化量之和；
则，通过比较t1,4，t2,4，t3,4，t4,4，t5,4的大小，将其中最大的时间对应的关节确定为第二关节m。
对于第二关节m对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，可以分为7段来得到N个插值点am,i，其中，i从1到N，具体的过程如下：
已知：预设的第一运动参数：第二关节的起始点的关节角度a1，终止点的关节角度b1，角度变化量S1＝b1-a1，插值周期Ts，第二关节对应的角度变化量S1的加加速度J1、最大加速度a1max、初始速度ve、终止速度vs和最大速度v1max，第二关节对应的角度变化量S1所对应的7段的插值点数分别为N1＝T1/Ts，N2＝T2/Ts，N3＝T3/Ts，N4＝T4/Ts，N5＝T5/Ts，N6＝T6/Ts和N7＝T7/Ts，7段S型的速度规划的对应的角度变化量的公式为：
Figure BDA0003446709550000171
其中，τi为7段S型角度变化量所对应的时间，Sm,i为第i个插值点与a1的角度变化量。
根据am,i＝a2+S2*(Sm,i/L总长度)确定第二关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，其中，对于第二关节L总长度为S2。
例如，根据第二关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点数，以及第二关节对应的角度变化量S1所对应的7段的插值点数，可以得出第i个插值点具体在哪一段，如N为25，N1为4，N2为2，N3为3，N4为7，N5为3，N6为2，N7为4时，第1个插值点在7段中的第1段，Sm,1可以根据Sm,i的第1个公式求得，τ1为τ1＝Ts*1；第21个插值点在7段中的第6段，Sm,20可以根据Sm,i的第6个公式求得，τ21为τ21＝Ts*21。
基于上述的原理，可以确定第二关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，具体为am,1,am,2,...,am,N。
针对除第二关节外的其他各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，具体的求得过程如下：
已知第二关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点am,i，以及ax,i＝ax+(am,i*Sx-am*Sx)/Sm确定多个关节中除第二关节外的其他各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点。其中，ax为除第二关节外其他任意一个关节对应的起始点的关节角度，Sm为第二关节对应的角度变化量，Sx为除第二关节外其他任意一个关节对应的角度变化量，ax,i为除第二关节外其他任意一个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点。
例如，第一关节对应的起始点的关节角度与终止点的关节角度之间的25个插值点为：第1个插值点为a1,1＝a1+(am,1*S1-am*S1)/Sm；第13个插值点为a1,13＝a1+(am,13*S1-am*S1)/Sm；第25个插值点为a1,25＝a1+(am,25*S1-am*S1)/Sm，最终，确定所有插值点a1,1,a1,2,...,a1,N；
第三关节对应的起始点的关节角度与终止点的关节角度之间的25个插值点为：第1个插值点为a3,1＝a3+(am,1*S3-am*S3)/Sm；第13个插值点为a3,13＝a3+(am,13*S3-am*S3)/Sm；第25个插值点为a3,25＝a3+(am,25*S3-am*S3)/Sm，最终，确定所有插值点a3,1,a3,2,...,a3,N；
第四关节对应的起始点的关节角度与终止点的关节角度之间的25个插值点为：第1个插值点为a4,1＝a4+(am,1*S4-am*S4)/Sm；第13个插值点为a4,13＝a4+(am,13*S4-am*S4)/Sm；第25个插值点为a4,25＝a4+(am,25*S4-am*S4)/Sm，最终，确定所有插值点a4,1,a4,2,...,a4,N；
第五关节对应的起始点的关节角度与终止点的关节角度之间的25个插值点为：第1个插值点为a5,1＝a5+(am,1*S5-am*S5)/Sm；第13个插值点为a5,13＝a5+(am,13*S5-am*S5)/Sm；第25个插值点为a5,25＝a5+(am,25*S5-am*S5)/Sm，最终，确定所有插值点a5,1,a5,2,...,a5,N。
可选地，S320，包括：根据预设的第一运动参数，机器人确定多个关节中各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点。
针对上述方案，本申请给出了如下一种实施例：
一种SCARA机器人，该机器人包括四个关节，第一关节、第二关节、第三关节和第四关节。第一关节对应的起始点的关节角度为a1，第一关节对应的终止点的关节角度为b1；第二关节对应的起始点的关节角度为a2，第二关节对应的终止点的关节角度为b2；第三关节对应的起始点的关节角度为a3，第三关节对应的终止点的关节角度为b3；第四关节对应的起始点的关节角度为a4，第四关节对应的终止点的关节角度为b4，根据四个关节对应的起始点的关节角度与终止点的关节角度，四个关节对应的角度变化量分别为：S1＝b1-a1，S2＝b2-a2，S3＝b3-a3，S4＝b4-a4。
已知：预设的第一运动参数为：各个关节对应的角度变化量的加加速度J1、最大加速度a1max、初始速度ve、终止速度vs和最大速度v1max，插值周期Ts，以及7段S型的速度规划的对应的角度变化量Sm,i的公式：
Figure BDA0003446709550000201
其中，τi为7段S型角度变化量所对应的时间，Sm,i为第m关节的第i个插值点与起始点的关节角度am之间的的角度变化量。
对上述四个关节对应的角度变化量分别采用7段S型的速度规划：
针对第一关节：起始点的关节角度a1，终止点的关节角度b1，在对第一关节的角度变化量S1采用7段S型的速度规划时，7段中每一段的时间分别为：T1＝a1max/J1，T2＝(v1max-ve)/a1max-a1max/J1，T3＝a1max/J1，T4＝(S1-Sa-Sb)/v1max，T5＝a1max/J1，T6＝((v1max-ve)/-a1max)-(-a1max/J1)和T7＝a1max/J1；第一关节对应的角度变化量S1所对应的7段的插值点数分别为N1＝T1/Ts，N2＝T2/Ts，N3＝T3/Ts，N4＝T4/Ts，N5＝T5/Ts，N6＝T6/Ts和N7＝T7/Ts；
其中，Sa＝ve(2T1+T2)+1/2J1T1(2T1 2+3T1T2+T2 2)，Sa为7段角度变化量中的第1段、第2段和第3段的角度变化量之和；Sb＝vmax(2T5+T6)-1/2J1T5(2T5 2+3T5T6+T6 2)，Sb为7段角度变化量中的第5段、第6段和第7段的角度变化量之和。
对第一关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，分为7段来得到N个插值点a1,i，其中，i从1到N，具体的过程为公式(1)，根据a1,i＝a1+S2*(S1,i/L总长度)确定第二关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，其中，对于第一关节L总长度为S1。
例如，根据第一关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点数，以及第一关节对应的角度变化量S1所对应的7段的插值点数，可以得出第i个插值点具体在哪一段，如N为25，N1为4，N2为2，N3为3，N4为7，N5为3，N6为2，N7为4时，第1个插值点在7段中的第1段，S1,1可以根据S1,i的第1个公式求得，τ1为τ1＝Ts*1；第21个插值点在7段中的第6段，S1,21可以根据S1,i的第6个公式求得，τ21为τ21＝Ts*21。
基于上述的原理，可以确定第一关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，具体为a1,1,a1,2,...,a1,N。
同理，可以得到其他三个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，具体为：第二关节a2,1,a2,2,...,a2,N；第三关节a3,1,a3,2,...,a3,N；第四关节a4,1,a4,2,...,a4,N。
应理解地，上述实施例中并不限定7段S型的的速度规划，也可以是5段S型的速度规划，也可以是T型的速度规划等。
S330，SCARA机器人确定第一端的上升高度对应的P个插值点和第一端的下降高度对应的Q个插值点，P+Q小于或等于N，N，P和Q为正整数。
可选地，步骤S330中的第一端的上升高度和下降高度相等时，P等于Q。
可选地，步骤S330，包括：根据预设的第二运动参数，SCARA机器人确定所述第一端的上升高度对应的P个插值点和所述第一端的下降高度对应的Q个插值点。
为了更好地理解本申请的技术方案，本申请提供了如下一种实施例：
已知：预设的第二运动参数：第一端的上升高度和下降高度对应的加加速度J2、最大加速度a2max、初始速度ve、终止速度vs和最大速度v2max；以及第一端的上升高度h1和下降高度h2。
可选地，h1＝h2。
由于第一端的升降是由第一关节的旋转来控制的，且第一端的升降的高度h与旋转的角度θ存在如下关系：θ＝2π*h/丝杆距
其中，丝杆距指第一关节旋转360度机器人的第一端上升或下降的高度。
例如，第一端的起始高度为0，上升高度为h1，则根据第一端的升降的高度h与旋转的角度θ的关系式得到第一关节对应的起始关节角度θ0和终止关节角度θ1，再确定第一关节对应的关节角度变化量Δθ，对第一关节对应的关节角度变化量Δθ进行7段S型速度规划，利用与步骤S320相同的原理求得与上升高度和下降高度对应的P个插值点的具体数值，并利用与步骤S320中，针对第二关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点相同的7段S型速度规划的原理，得到第一端的上升高度对应的P个插值点，以及第一端的下降高度对应的Q个插值点。
可选地，在根据预设的第二运动参数，SCARA机器人确定第一端的上升高度对应的P个插值点和第一端的下降高度对应的Q个插值点之前，方法还包括：
若第一端的上升高度对应的插值点数量与第一端下降高度对应的插值点数量之和大于N，则SCARA机器人调整预设的第三运动参数；
SCARA机器人将调整后的第三运动参数确定为第二运动参数。
上述方案中，预设的第三运动参数可以确定第一端的上升高度对应的插值点数量与第一端下降高度对应的插值点数量，调整预设的第三运动参数，是为了使P+Q小于或等于N，这样得到的第一端的上升高度对应的P个插值点和第一端的下降高度对应的Q个插值点，才可以与起始点位置处第一关节对应的起始点的关节角度与终止点位置处的关节角度之间运动插补对应的N个插值点进行求和。
例如，第三运动参数：第一端的上升高度与下降高度对应的加加速度J3、加速度a3,max、初始速度ve、终止速度vs和最大速度v3max。当P+Q大于N时，可以将第一端的上升高度与下降高度对应的最大速度v3max、加速度a3,max增大，得到第二运动参数。
可选地，当第一端的上升高度与下降高度相等时，在根据预设的第二运动参数，SCARA机器人确定第一端的上升高度对应的P个插值点和第一端的下降高度对应的P个插值点之前，方法还包括：
若第一端的上升高度对应的插值点数量P大于N/2，则SCARA机器人调整预设的第三运动参数；
SCARA机器人将调整后的第三运动参数确定为第二运动参数。
上述方案中，预设的第三运动参数可以确定第一端的上升高度对应的插值点数量与第一端下降高度对应的插值点数量，调整预设的第三运动参数，是为了使P小于或等于N/2，这样得到的第一端的上升高度对应的P个插值点和第一端的下降高度对应的P个插值点，才可以与第一关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点进行求和。
例如，第三运动参数：第一端的上升高度与下降高度对应的加加速度J3、加速度a3,max、初始速度ve、终止速度vs和最大速度v3max。当h1＝h2时，此时P＝Q，则当P大于N/2时，可以将第一端的上升高度与下降高度对应的最大速度v3max、加速度a3,max增大，得到第二运动参数。
S340，根据各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点、P个插值点和Q个插值点，SCARA机器人确定起始点到终止点之间的第一端的移动的规划路径。
可选地，步骤S340，包括：根据P个插值点和Q个插值点，SCARA机器人确定第一端在上升高度与下降高度对应的N个插值点；
将第一端在上升高度与下降高度对应的N个插值点和第一关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点一一对应求和，SCARA机器人更新第一关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点；
根据更新的第一关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点和多个关节中除第一关节外的其他各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，SCARA机器人确定起始点到终止点之间的第一端的移动的规划路径。
上述方案中，由于第一端的上升高度与下降高度是由第一关节来旋转控制的，因此，可以将第一端在上升高度与下降高度对应的N个插值点与第一关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点一一对应求和，从而更新第一关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，进而再与除第一关节外的其他各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，共同确定SCARA机器人的第一端的运行路径，而不是盲目地规划路径，造成第一端可能碰撞障碍物的问题。
为了更好地理解本申请的方案，本申请给出了如下实施例：
第一端在上升高度与下降高度对应的N个插值点具体为：P1,1,P1,2,...P1,N；
第一关节对应的起始点P1,1,P1,2,...P1,N关节角度与终止点的关节角度之间运动插补对应的N个插值点为：a1,1,a1,2,...,a1,N；
将P1,1,P1,2,...P1,N与a1,1,a1,2,...,a1,N一一对应求和，得到更新的第一关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点：a’1,1,a’1,2,...,a’1,N。
根据更新的第一关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点：a’1,1,a’1,2,...,a’1,N、第二关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点：am,1,am,2,...,am,N、第三关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点：a3,1,a3,2,...,a3,N和第四关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点：a4,1,a4,2,...,a4,N，在P1与P2之间，确定N个位置点，由这样N+2个位置点连接起来的路径作为起始点到终止点之间的第一端的移动的规划路径，例如，利用得到的各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点规划出的第一端的移动的规划路径如图6所示的第一路径，末端使用第一路径避障时，在拐点处末端会经过一个类似圆弧的路径，也就是图6中的c、d，末端以图中的第一路径移动时，不仅可以避开障碍物，也可以在拐点处不停顿保持相对小的速度前行，而避免末端使用第二路径需要停顿，使SCARA机器人工作效率差的问题。
可选地，根据P个插值点和Q个插值点，确定第一端在上升高度与下降高度对应的N个插值点，具体包括：
若P+Q小于N，将P个插值点与Q个插值点按照第一排序规则，确定P+Q个插值点；
在P+Q个插值点中插补N-P-Q个第一值，确定第一端在上升高度与下降高度对应的N个插值点；
若P+Q等于N，将P个插值点与Q个插值点按照第一顺序规则，确定第一端在上升高度与下降高度对应的N个插值点。
可选地，第一值为0度。
上述方案中，P个插值点和Q个插值点分别为第一端的上升高度和下降高度对应的插值点，第一端的升降是通过第一关节关节角度来控制的，可以将第一端的上升高度和下降高度对应的插值点与第一关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点求和，因此，需要确保由第一端的上升高度和下降高度对应的插值点的数量与N值相等。
为了更好地理解本申请的方案，本申请提供了如下实施例：
若P+Q小于N，且P个插值点具体为P1,1,P1,2,...P1,P；Q个插值点具体为Q1,1,Q1,2,...Q1,Q时，按照第一排序规则：将P个插值点中P1,1,P1,2,...P1,P按照正序从1位置依次排序依次排列，将Q个插值点中的Q1,1,Q1,2,...Q1,Q按照正序从N-Q+1位置依次排列，将P+1～N-Q位置的插值点设为0；
第一端在上升高度与下降高度对应的N个插值点为：P1,1,P1,2,...P1,P,0,...0,Q1,1,Q1,2,...Q1,Q。
若P+Q等于N，且P个插值点具体为P1,1,P1,2,...P1,P；Q个插值点具体为Q1,1,Q1,2,...Q1,Q时，按照第一排序规则：将P个插值点中P1,1,P1,2,...P1,P按照正序从1位置依次排序依次排列，将Q个插值点中的Q1,1,Q1,2,...Q1,Q按照正序从P+1位置依次排列；
第一端在上升高度与下降高度对应的N个插值点为：P1,1,P1,2,...P1,P,Q1,1,Q1,2,...Q1,Q。
图7为本申请实施例提供的一种确定规划路径的装置示意图，如图7所示，本实施例提供的装置包括：
获取单元710，用于获取装置待规划路径的起始点、待规划路径的终止点、第一端的上升高度和下降高度，起始点与多个关节的关节角度一一对应，终止点与多个关节的关节角度一一对应；
确定单元720，用于多个关节中各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点；
所述确定单元，还用于确定第一端的上升高度对应的P个插值点和第一端的下降高度对应的Q个插值点，P+Q小于或等于N，N，P和Q为正整数；
所述确定单元，还用于根据各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点、P个插值点和Q个插值点确定起始点到终止点之间的第一端的移动的规划路径。
可选地，所述确定单元具体用于，根据多个关节中各个关节对应的起始点的关节角度与终止点的关节角度，确定各个关节对应的角度变化量；
根据各个关节对应的预设的第一运动参数，确定各个关节移动各自的角度变化量所需要的运动总时间；
在多个关节中将最大总时间对应的关节确定为第二关节；
根据预设的第一运动参数，确定第二关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点；
根据第二关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，确定多个关节中除第二关节外的其他各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点。
可选地，所述确定单元还具体用于，根据除第二关节外的其他各个关节对应的起始点的关节角度、第二关节对应的起始点的关节角度、第二关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点、第二关节对应的角度变化量和除第二关节外的其他各个关节对应的角度变化量，确定除第二关节外的其他各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点。
可选地，第一端的上升高度和下降高度相等时，P等于Q。
可选地，该装置还包括：处理单元用于根据预设的第二运动参数，确定第一端的上升高度对应的P个插值点和第一端的下降高度对应的Q个插值点。
可选地，所述处理单元具体还用于，若第一端的上升高度对应的插值点数量与第一端下降高度对应的插值点数量之和大于N，则调整预设的第三运动参数；
将调整后的第三运动参数确定为第二运动参数。
可选地，所述确定单元还用于，根据P个插值点和Q个插值点，确定第一端在上升高度与下降高度对应的N个插值点。
可选地，该装置还包括：更新单元用于将第一端在上升高度与下降高度对应的N个插值点和第一关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点一一对应求和，更新第一关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点。
可选地，所述确定单元还用于，根据更新的第一关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点和多个关节中除第一关节外的其他各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，确定起始点到终止点之间的第一端的移动的规划路径。
可选地，所述确定单元具体还用于，若P+Q小于N，将P个插值点与Q个插值点按照第一排序规则，确定P+Q个插值点；
在P+Q个插值点中插补N-P-Q个第一值，确定第一端在上升高度与下降高度对应的N个插值点；
若P+Q等于N，将P个插值点与Q个插值点按照第一顺序规则，确定第一端在上升高度与下降高度对应的N个插值点。
基于同一发明构思，图8为本申请实施例提供的一种SCARA机器人，包括处理器，处理器与存储器耦合，处理器用于执行存储器中存储的计算机程序或指令时，以实现上述第一方面或第一方面的任一实施方式的方法。
可选地，SCARA机器人还包括支撑组件，支撑组件用于支撑SCARA机器人。
基于同一发明构思，本申请实施例提供了一种介质，该介质上存储有计算机程序，计算机程序被处理器执行时，以实现上述第一方面或第一方面的任一实施方式的方法。
在本申请所提供的实施例中，应该理解到，所揭露的装置/设备和方法，可以通过其它的方式实现。例如，以上所描述的装置/设备实施例仅仅是示意性的，例如，所述模块或单元的划分，仅仅为一种逻辑功能划分，实际实现时可以有另外的划分方式，例如多个单元或组件可以结合或者可以集成到另一个系统，或一些特征可以忽略，或不执行。另一点，所显示或讨论的相互之间的耦合或直接耦合或通讯连接可以是通过一些接口，装置或单元的间接耦合或通讯连接，可以是电性，机械或其它的形式。
最后应说明的是：以上各实施例仅用以说明本申请的技术方案，而非对其限制；尽管参照前述各实施例对本申请进行了详细的说明，本领域的普通技术人员应当理解：其依然可以对前述各实施例所记载的技术方案进行修改，或者对其中部分或者全部技术特征进行等同替换；而这些修改或者替换，并不使相应技术方案的本质脱离本申请各实施例技术方案的范围。

Claims (10)

1.一种确定规划路径的方法，其特征在于，所述方法应用于SCARA机器人，所述SCARA机器人包括多个关节，所述多个关节包括第一关节，所述第一关节用于控制所述机器人的第一端升降，所述方法包括：
获取所述SCARA机器人待规划路径的起始点、所述待规划路径的终止点、所述第一端的上升高度和下降高度，起始点与多个关节的关节角度一一对应，终止点与多个关节的关节角度一一对应；
确定所述多个关节中各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点；
确定所述第一端的上升高度对应的P个插值点和所述第一端的下降高度对应的Q个插值点，P+Q小于或等于N，N，P和Q为正整数；
根据所述各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点、所述P个插值点和所述Q个插值点确定所述起始点到所述终止点之间的所述第一端的移动的规划路径。
2.如权利要求1所述的方法，其特征在于，所述确定所述多个关节中各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，包括：
根据所述多个关节中各个关节对应的起始点的关节角度与终止点的关节角度，确定所述各个关节对应的角度变化量；
根据所述各个关节对应的预设的第一运动参数，确定所述各个关节移动各自的角度变化量所需要的运动总时间；
在所述多个关节中将最大运动总时间对应的关节确定为第二关节；
根据所述预设的第一运动参数，确定所述第二关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点；
根据所述第二关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，确定所述多个关节中除所述第二关节外的其他各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点。
3.如权利要求2所述的方法，其特征在于，所述根据所述第二关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，确定所述多个关节中除所述第二关节外的其他各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，包括：
根据除所述第二关节外的其他各个关节对应的起始点的关节角度、所述第二关节对应的起始点的关节角度、所述第二关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点、所述第二关节对应的角度变化量和除所述第二关节外的其他各个关节对应的角度变化量，确定除所述第二关节外的其他各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点。
4.如权利要求1或2所述的方法，其特征在于，所述第一端的上升高度和下降高度相等时，所述P等于所述Q；
其中，所述确定所述第一端的上升高度对应的P个插值点和所述第一端的下降高度对应的Q个插值点，包括：
根据预设的第二运动参数，确定所述第一端的上升高度对应的P个插值点和所述第一端的下降高度对应的Q个插值点。
5.如权利要求4所述的方法，其特征在于，在所述根据预设的第二运动参数，确定所述第一端的上升高度对应的P个插值点和所述第一端的下降高度对应的Q个插值点之前，所述方法还包括：
若所述第一端的上升高度对应的插值点数量与所述第一端下降高度对应的插值点数量之和大于N，则调整预设的第三运动参数；
将调整后的所述第三运动参数确定为所述第二运动参数。
6.如权利要求1所述的方法，其特征在于，所述根据所述各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点、所述P个插值点和所述Q个插值点确定所述起始点到所述终止点之间的所述第一端的移动的规划路径，包括：
根据所述P个插值点和所述Q个插值点，确定所述第一端在所述上升高度与所述下降高度对应的N个插值点；
将所述第一端在所述上升高度与所述下降高度对应的N个插值点和所述第一关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点一一对应求和，更新所述第一关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点；
根据所述更新的所述第一关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点和所述多个关节中除所述第一关节外的其他各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点，确定所述起始点到所述终止点之间的所述第一端的移动的规划路径。
7.如权利要求6所述的方法，其特征在于，所述根据所述P个插值点和所述Q个插值点，确定所述第一端在所述上升高度与所述下降高度对应的N个插值点，包括：
若P+Q小于N，将所述P个插值点与所述Q个插值点按照第一排序规则，确定P+Q个插值点；
在所述P+Q个插值点中插补N-P-Q个第一值，确定所述第一端在所述上升高度与所述下降高度对应的N个插值点；
若P+Q等于N，将所述P个插值点与所述Q个插值点按照所述第一顺序规则，确定所述第一端在所述上升高度与所述下降高度对应的N个插值点。
8.一种确定规划路径的装置，其特征在于，所述装置包括：
获取单元，用于获取所述装置待规划路径的起始点、待规划路径的终止点、第一端的上升高度和下降高度，所述起始点与所述多个关节的关节角度一一对应，所述终止点与所述多个关节的关节角度一一对应；
确定单元，用于确定所述多个关节中各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点；
所述确定单元，还用于确定所述第一端的上升高度对应的P个插值点和所述第一端的下降高度对应的Q个插值点，P+Q小于或等于N，N，P和Q为正整数；
所述确定单元，还用于根据所述各个关节对应的起始点的关节角度与终止点的关节角度之间运动插补对应的N个插值点、所述P个插值点和所述Q个插值点确定所述起始点到所述终止点之间的所述第一端的移动的规划路径。
9.一种SCARA机器人，包括处理器，所述处理器与存储器耦合，所述处理器用于执行所述存储器中存储的计算机程序或指令时，以实现如权利要求1-7中任一项所述的方法。
10.一种介质，其特征在于，所述介质上存储有计算机程序，所述计算机程序被处理器执行时，以实现如权利要求1-7任一项所述的方法。
CN202111658542.4A 2021-12-30 2021-12-30 确定规划路径的方法、装置、scara机器人及介质 Active CN114227655B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202111658542.4A CN114227655B (zh) 2021-12-30 2021-12-30 确定规划路径的方法、装置、scara机器人及介质

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202111658542.4A CN114227655B (zh) 2021-12-30 2021-12-30 确定规划路径的方法、装置、scara机器人及介质

Publications (2)

Publication Number Publication Date
CN114227655A true CN114227655A (zh) 2022-03-25
CN114227655B CN114227655B (zh) 2024-06-04

Family

ID=80744929

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111658542.4A Active CN114227655B (zh) 2021-12-30 2021-12-30 确定规划路径的方法、装置、scara机器人及介质

Country Status (1)

Country Link
CN (1) CN114227655B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115837669A (zh) * 2022-10-14 2023-03-24 港珠澳大桥管理局 五自由度机械臂笛卡尔空间直线轨迹规划方法及装置

Citations (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH07152380A (ja) * 1994-08-19 1995-06-16 Yamaha Corp 楽音制御情報発生装置
CN102091752A (zh) * 2010-11-25 2011-06-15 中南大学 一种自动化锻造的操作机与压机联动轨迹规划方法
CN103076759A (zh) * 2012-12-31 2013-05-01 北京配天大富精密机械有限公司 一种获取数控系统的s型曲线的方法及其装置
EP2889830A1 (en) * 2013-12-31 2015-07-01 Huawei Technologies Co., Ltd. Image enlargement method and apparatus
CN105082135A (zh) * 2015-09-11 2015-11-25 东南大学 一种机器人点动操作的速度控制方法
WO2017113219A1 (zh) * 2015-12-30 2017-07-06 深圳配天智能技术研究院有限公司 折弯跟随轨迹规划方法、装置及系统
CN107139173A (zh) * 2017-06-15 2017-09-08 华南理工大学 一种工业机器人门型轨迹插补方法
CN107433593A (zh) * 2017-09-07 2017-12-05 龙海铂格自动化设备有限责任公司 并联机器人食品分拣加工系统
CN108287527A (zh) * 2017-07-18 2018-07-17 山东大学 一种基于三角函数的改进s曲线加减速控制方法
CN108549324A (zh) * 2018-05-16 2018-09-18 山东大学 用于高速分拣系统的工件跟随抓取轨迹规划方法及系统
CN108549322A (zh) * 2018-04-11 2018-09-18 广州启帆工业机器人有限公司 一种针对机器人圆弧轨迹运动的位姿同步方法和装置
CN109108983A (zh) * 2018-10-12 2019-01-01 中国航天空气动力技术研究院 基于分拣工艺的机械手轨迹规划方法
CN110253578A (zh) * 2019-06-21 2019-09-20 广东工业大学 Scara机器人及其运动控制方法、系统及相关组件
CN112356036A (zh) * 2020-11-23 2021-02-12 北京配天技术有限公司 一种scara机器人轨迹规划方法、装置、设备及存储介质

Patent Citations (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH07152380A (ja) * 1994-08-19 1995-06-16 Yamaha Corp 楽音制御情報発生装置
CN102091752A (zh) * 2010-11-25 2011-06-15 中南大学 一种自动化锻造的操作机与压机联动轨迹规划方法
CN103076759A (zh) * 2012-12-31 2013-05-01 北京配天大富精密机械有限公司 一种获取数控系统的s型曲线的方法及其装置
EP2889830A1 (en) * 2013-12-31 2015-07-01 Huawei Technologies Co., Ltd. Image enlargement method and apparatus
CN105082135A (zh) * 2015-09-11 2015-11-25 东南大学 一种机器人点动操作的速度控制方法
WO2017113219A1 (zh) * 2015-12-30 2017-07-06 深圳配天智能技术研究院有限公司 折弯跟随轨迹规划方法、装置及系统
CN107139173A (zh) * 2017-06-15 2017-09-08 华南理工大学 一种工业机器人门型轨迹插补方法
CN108287527A (zh) * 2017-07-18 2018-07-17 山东大学 一种基于三角函数的改进s曲线加减速控制方法
CN107433593A (zh) * 2017-09-07 2017-12-05 龙海铂格自动化设备有限责任公司 并联机器人食品分拣加工系统
CN108549322A (zh) * 2018-04-11 2018-09-18 广州启帆工业机器人有限公司 一种针对机器人圆弧轨迹运动的位姿同步方法和装置
CN108549324A (zh) * 2018-05-16 2018-09-18 山东大学 用于高速分拣系统的工件跟随抓取轨迹规划方法及系统
CN109108983A (zh) * 2018-10-12 2019-01-01 中国航天空气动力技术研究院 基于分拣工艺的机械手轨迹规划方法
CN110253578A (zh) * 2019-06-21 2019-09-20 广东工业大学 Scara机器人及其运动控制方法、系统及相关组件
CN112356036A (zh) * 2020-11-23 2021-02-12 北京配天技术有限公司 一种scara机器人轨迹规划方法、装置、设备及存储介质

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115837669A (zh) * 2022-10-14 2023-03-24 港珠澳大桥管理局 五自由度机械臂笛卡尔空间直线轨迹规划方法及装置

Also Published As

Publication number Publication date
CN114227655B (zh) 2024-06-04

Similar Documents

Publication Publication Date Title
WO2018086226A1 (zh) 机械臂的控制方法和装置
US8774965B2 (en) Method and device for controlling a manipulator
WO2022160894A1 (zh) 基于迭代学习的数控机床快速误差补偿控制系统及方法
WO2021004218A1 (zh) 机床运动轨迹的控制方法及装置、存储介质、处理器
CN108189038A (zh) 一种实用的工业六轴机械臂直线运动轨迹规划方法及系统
CN109605369B (zh) 机械臂奇异点控制方法及系统
CN114227655A (zh) 确定规划路径的方法、装置、scara机器人及介质
CN111604905B (zh) 关节轨迹规划的方法、装置、系统及存储介质
CN109375584A (zh) 臂架关节控制方法及系统及包含该系统的工程机械
CN107450466A (zh) 一种冲压机器人控制器及其高速平稳控制方法
CN111267090A (zh) 一种双臂机器人主从控制系统及方法
CN108490874B (zh) 一种双轴运动控制系统的非线性pid交叉耦合控制方法
CN103454979B (zh) 一种封装成PLCOpen指令的变速曲线圆弧快速插补方法
CN109093624B (zh) 一种机械臂复杂曲线的连续插补运动控制方法
CN116494250A (zh) 基于速度补偿的机械臂控制方法、控制器、介质及系统
JP2010110878A (ja) 多関節型ロボット装置およびその制御方法
CN111405966B (zh) 用于控制机器人组的方法和控制装置
CN111670093A (zh) 机器人的运动控制方法、控制系统和存储装置
CN109129470B (zh) 机器人直线路径的规划方法及系统
CN107290959B (zh) 一种基于位移等效的机器人笛卡尔空间速度优化方法
CN109648563A (zh) 串联机器人运动控制方法及计算机存储介质
CN115808904A (zh) 一种工业机器人圆弧过辅助点轨迹规划方法
CN115167429A (zh) 一种移动机器人位置和姿态同时规划方法
CN114305265A (zh) 凹凸面实时跟随轨迹规划方法及系统
CN113848809A (zh) 基于数值滤波的轨迹规划方法

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant