技术特征：
1.一种机械臂的工作方法，其特征在于：通过机械臂实现，机械臂包括座体，在座体上设有转动装置；在转动装置上安装有夹持装置；夹持装置包括屈伸装置和夹持件；屈伸装置的一端与转动装置连接，屈伸装置的另一端与夹持件连接；屈伸装置包括第一屈伸支架、第二屈伸支架和第三屈伸支架；第一屈伸支架、第二屈伸支架和第三屈伸支架之间可相对活动；机械臂的工作方法，包括以下步骤：步骤（1）.以座体为原点建立第一平面坐标系a；预设转动装置和第一屈伸支架铰接处与第一屈伸支架和第二屈伸支架节铰接处之间的距离l1；预设第一屈伸支架和第二屈伸支架铰接处与第二屈伸支架和第三屈伸支架铰接处之间的距离l2；预设第二屈伸支架和第三屈伸支架铰接处与夹持件之间的距离l3；步骤（2）.通过第一摄像装置获取物品的位置；转动装置驱动夹持装置转动使夹持装置的活动方向与物品对应；步骤（3）.以座体为原点，以机械臂物品为平面建立与第一平面坐标系a垂直的第二平面坐标系b；步骤（4）.确定第一坐标和第二坐标；第一坐标为物品在第二坐标系b中的坐标；第二坐标夹持件在第二坐标系b中能夹取物品的坐标；步骤（5）.通过第二摄像装置获取第一屈伸支架和第二屈伸支架铰接处与座体所在水平面在第二平面坐标系b中的高度距离y1；第二屈伸支架和第三屈伸支架铰接处与第一屈伸支架和第二屈伸支架铰接处在第二平面坐标系b中的高度距离y2；夹持件与第二屈伸支架和第三屈伸支架铰接处在第二平面坐标系b中的高度距离y3；通过勾股定理计算第一屈伸支架和第二屈伸支架铰接处与座体在第二平面坐标系b中的长度距离x1；第二屈伸支架和第三屈伸支架铰接处与第一屈伸支架和第二屈伸支架铰接处在第二平面坐标系b中长度距离x2；夹持件与第二屈伸支架和第三屈伸支架铰接处在第二平面坐标系b中长度距离x3；通过第二坐标（x，y）、公式x= x1+ x2+ x3；y= y1+ y 2+ y 3；cos θ1=x1/l1；cos (θ
1+
θ2)=x2/l2；cos (θ
1+
θ
2+
θ3)=x3/l3；计算θ1、θ2和θ3的角度；以第一屈伸支架与水平面平行方向为始边，第一屈伸支架向上摆动为正方向；以第二屈伸支架与第一屈伸支架平行方向为始边，第二屈伸支架向上摆动为正方向；以第三屈伸支架与第二屈伸支架平行方向为始边，第三屈伸支架向上摆动为正方向；计算θ1、θ2和θ3的角度；θ1为第一屈伸支架与底座所在水平面之间的夹角；θ2为第二屈伸支架与第一屈伸支架之间的夹角；θ3为第三屈伸支架与第二屈伸支架之间的夹角；步骤（6）.摆动第一屈伸支架、第二屈伸支架和第三屈伸支架；使第一屈伸支架与底座所在水平面之间的夹角为θ1；第二屈伸支架与第一屈伸支架之间的夹角为θ2；第三屈伸支架与第二屈伸支架之间的夹角为θ3；夹持件移动到第二坐标；步骤（7）.夹持件夹取物品；然后通过转动装置驱动夹持装置转动；带动物品转动到放置区域。2.根据权利要求1所述的一种机械臂的工作方法，其特征在于：转动装置包括转动舵机；转动舵机带动夹持装置转动；转动舵机连接有角度传感器。3.根据权利要求2所述的一种机械臂的工作方法，其特征在于：步骤（1）还包括：以第一平面坐标系a中y轴为始边，顺时针转动为正方向；通过角度传感器记录夹持装置中线与第一平面坐标系a中y轴的夹角b的角度。
4.根据权利要求3所述的一种机械臂的工作方法，其特征在于：步骤（2）具体为：以原点为起点，物品中点为终点构建第一延长线；通过第一摄像装置获取第一延长线与第一平面坐标系a中y轴的夹角a的角度；计算夹角a与夹角b之间的差值；转动舵机驱动夹持装置摆动；使夹持装置中线与第一延长线重合。5.根据权利要求1所述的一种机械臂的工作方法，其特征在于：所述第一屈伸支架连接有第一驱动装置，第一屈伸支架通过第一驱动装置与转动装置连接；所述第二屈伸支架连接有第二驱动装置，第二屈伸支架通过第二驱动装置与第一屈伸支架连接；所述第三屈伸支架连接有第三驱动装置，第三屈伸支架通过第三驱动装置与第二屈伸支架连接；第一驱动装置、第二驱动装置和第三驱动装置都连接有角度传感器。6.根据权利要求1所述的一种机械臂的工作方法，其特征在于：所述步骤（1）还包括：以第一屈伸支架与水平面平行为初始状态设置第一屈伸支架与水平面之间的初始角度为0；以第二屈伸支架与第一屈伸支架平行为初始状态预设第二屈伸支架与第一屈伸支架之间的初始角度为0；以第三屈伸支架与第二屈伸支架平行为初始状态预设第三屈伸支架与第二屈伸支架之间的初始角度为0；通过角度传感器记录第一屈伸支架与水平面之间的当前角度、第二屈伸支架与第一屈伸支架之间的当前角、第三屈伸支架与第二屈伸支架之间的当前角度。7.根据权利要求6所述的一种机械臂的工作方法，其特征在于：步骤（6）具体为：计算第一屈伸支架与水平面之间的当前角度与θ1之间的差值；第一驱动装置驱动第一屈伸支架摆动；使第一屈伸支架与水平面之间的之间的角度为θ1；计算第二屈伸支架与第一屈伸支架之间的当前角度与θ2之间的差值；第二驱动装置驱动第二屈伸支架摆动；使第二屈伸支架与第一屈伸支架面之间的之间的角度为θ2；计算第三屈伸支架与第二屈伸支架之间的当前角度与θ3之间的差值；第三驱动装置驱动第三屈伸支架摆动；使第三屈伸支架与第二屈伸支架面之间的之间的角度为θ3；夹持件移动到第二坐标。
技术总结
本发明提供一种机械臂的工作方法；通过转动装置驱动夹持装置的活动方向与物品对应；然后以夹持装置中线与物品中点构建第二平面坐标系B；第二平面坐标系B与第一平面坐标系A垂直；当夹持装置与物品处于同一平面时只需考虑X坐标和Y坐标就能控制机械臂移动靠近物品；方法简单；通过x1、x2和x3计算第二坐标的x坐标；通过y1、y2和y3计算第二坐标的y坐标；然后计算出第一屈伸支架对应的摆动角度θ1；第二屈伸支架对应的摆动角度θ2；第三屈伸支架对应的摆动角度θ3。通过勾股定理和三角函数进行计算；方法简单；通过确定第一屈伸支架、第二屈伸支架和第三屈伸支架的摆动正方向；这样能对θ1、θ2和θ3的正负数值进行区分；便于控制屈伸装置摆动。伸装置摆动。伸装置摆动。
技术研发人员：周政 陈雪娇 缪文南 郭昊
受保护的技术使用者：广州城市理工学院
技术研发日：2021.12.16
技术公布日：2022/2/11