专利名称：毽球机器人及控制方法
技术领域：
-
本发明属于机器人领域，特别涉及一种能够在三维空间活动的毽球机器人及控制方法。
技术背景-
自1959年第一台真正意义上的机器人在美国诞生，机器人技术经历了飞速的发展，其发 展方向也日趋智能化、专业化。在体育机器人系统的开发过程中，不仅要综合人工智能、精 密机械、通讯与计算机技术等，而且还涉及图像处理、传感器数据融合、决策与对策等多学 科的内容。毽球机器人作为体育机器人众多分支中的一.支，已成为国内外各科研机构、学术 单位重点发展的项目。然而，由于传统的体育机器人对于数据的处理及动作反馈大多局限于 二维空间，使其视觉系统对物体位置的预判效果不好，导致对物体的识别和定位不够精确。 体现在毽球机器人上，就是毽球机器人对毽球位置的预判效果不好，导致对毽球的识别和定 位不够精确。
发明内容
本发明针对现有体育机器人对于数据的处理及动作反馈仅局限于二维空间的问题，提供 一种能够在三维空间活动的毽球机器人及控制方法。
为了实现上述目的，本发明采用如下技术方案， 一种毽球机器人，包括运行轨道部分、
击球部分及视觉部分，所述的运行轨道部分包括具有纵向轨道的底座，在纵向轨^:'上设置有
可在纵向轨道上运动的上方具有横向轨道的纵向滑块，-在纵向滑块的横向轨道上设置有可在
横向轨道上运动的横向滑块；在纵向轨道间、横向轨道间分别设置有纵向同步带、横向同步 带，纵向同步带、横向同步带分别与底座侧方的纵向控制电机、横向控制电机相连；在横向 滑块上设置有所述的击球部分，所述的击球部分包括固定有球拍的底板，球拍的轴与电机的 蜗轮减速器的轴相连；所述的视觉部分包括设置在毽球场地上方的与毽球机器人控制系统相 连的两个互相垂直的摄像头；在轨道部分的纵向控制电机、横向控制电机及击球部分的电机 内部设置有检测球拍角度及位置信息的传感器。
所述的毽球机器人的控制方法，包括如下步骤
步骤一通过两个互相垂直的摄像头采集两幅互相垂直的二维平面图像，并通过OPENCV 软件将采集到的二维平面图像进行二值化处理，得到两幅二值图像；最后在两幅二值图像中 提取出毽球的图像坐标，并对提取的毽球的图像坐标进行图像径向畸变和投影畸变的校正， 将毽球的图像坐标转换为相对于场地的实际坐标；
步骤二根据两幅互相垂直的二值图像建立三维直角坐标系，在三维直角坐标系中确定 毽球在水平二值图像中的实际坐标P^Xb y" O)及毽球在垂直二值图像中的实际坐标P2(0, y2， z2);测得垂直摄像头在三维直角坐标系中的实际坐标Pd (x山y。,，Zd)及水平摄像头在三维直角坐标系中的实际坐标PC2(Xe2，ye2，Z。2);连接^与PC:，得到空间直线U，连接P2与PC2，
得到空间直线L2，空间直线"、L2的公垂线段的中点Pt(Xt,yt,Zt)即为毽球在三维直角坐标系 中的坐标；
步骤三对步骤二中求得的毽球在三维直角坐标系中的坐标Pt(Xt，yt，Zt)进行卡尔曼滤
波，得到一个滤波后的毽球在三维直角坐标系中的坐标Pt' (Xt，yt，Zt);
步骤四通过力学分析得到毽球的轨迹运动方程；再结合步骤三中得到的滤波后的毽球 在三维直角坐标系中的坐标Pt' (xt,yt,zt)，用最小二乘法进行轨迹预估；预估得到毽球下一 时刻落点的三维坐标P(Xp, yP, Zp)，并将该点的坐标传入信号控制系统；
步骤五通过设置在轨道部分及击球部分的电机内部的传感器，检测球拍的角度信息及
位置信息，并以电压信号传入信号控制系统；信号控制系统再结合步骤四中得到的毽球下一
时刻落点的三维坐标P(Xp，yp，Zp)，计算出毽球机器人的'运动量，并通过电机伺服控制系统控
制电机，完成毽球机器人沿轨道的运行及击球的动作；即由纵向控制电机及横向控制电机带
动击球部分在水平轨道部分运动，而后再控制击球部分的电机执行击球动作。
所述的对图像坐标进行图像径向畸变和投影畸变的校正，将毽球的图像坐标转换为相对 于场地的实际坐标，具体实现过程如下
(1) 对两个互相垂直的摄像头所视毽球场地沿场地内沿分别加以标定，以场地左上角为 原点，测出标定点的实际坐标；并通过在图像中点击标定点得出标定点的图像坐标；
(2) 利用径向畸变的多项式标定方法，建立实际坐标(xw， yw)与图像坐标(u， v)之 间的三次多项式关系:
<formula>formula see original document page 7</formula>
(3) 根据步骤(1)中测出的标定点的实际坐标及图像坐标，利用最小二乘法解超定方
程组
<formula>formula see original document page 7</formula>[y, - (6。 + Vu +…+)ki = o [乂-(Wd+…+V'丄=0
,=1
(3)
其中，",( 0,1,2…9)， W!、0,l，2…9)为参数，求出",(/ = 0，1,2...9)， = 0,1,2…9)的
值；即建立了图像坐标与实际坐标之间的映射关系；
(4)根据步骤(3)中建立的图像坐标与实际坐标之间的映射关系，及步骤一中在两幅 二值图像中提取出的毽球的图像坐标，求出毽球相对于毽球场地的实际坐标。
所述的毽球在三维直角坐标系中的坐标Pt Oct, yt, Zt)的具体计算过程如下
(1)求取空间直线"、L2的方程 空间直线L"'
y一A
空间直线L2
;c一x，
y一h
(4)
(5)
一 乂2 _少2 Z
c2
(2) 以距离平方和为目标函数的求取
似0,，;^)=《20,,;^,2,) + ^22"，；^) (6)
其中，M(x,，^z,)'为目标函数，《，A分别为毽球在三维直角坐标系中的坐标Pt(Xt， yt, Zt)
距空间直线；^的距离；
(3) 毽球在三维直角坐标系中的坐标Pt (xt， yt， Zt)的求得
对步骤(2)中求取的目标函数M"'，y'，z')分别求关于W(，z'的偏导数，联立成方程组:
9x,
3M(x'，x，z,)
=0 =0 =0
(7)
求解此方程组，得到毽球在三维直角坐标系中的坐标Pt (Xt, yt, Zt)的坐标值( 所述的轨迹预估的具体过程^口下建立空气阻力模型<formula>formula see original document page 9</formula>(8)
其中，k为毽球的固有参数，在空气密度基本不变的情况下与其体积及形状有关; 此外，毽球还受重力，
<formula>formula see original document page 9</formula>(9)
<formula>formula see original document page 9</formula>(10)
附
根据牛顿运动学定律，又有
<formula>formula see original document page 9</formula>
(11)
由于毽球是在三维空间内运动，现将毽球的运动分解为三个沿轴方向上运动的分量，综
合以上方程，最终得到毽球轨迹的运动方程
<formula>formula see original document page 9</formula>以X方向为例:
(13)
<formula>formula see original document page 9</formula> ，将其化为
<formula>formula see original document page 9</formula>
(14)
结合步骤三中得到的滤波后的毽球在三维直角坐标系中的坐标Pt' (Xt, yt， zt)，用最小 乘法进行轨迹预估，得方程组<formula>formula see original document page 10</formula>，
解此方程组，即得参数"Q，"i的值；同理，求得y方向的参数6。^的值，z方向的参数c。，c, 的值，即得到了预估曲线；
令方程(13)中的2") = //0 (16)
其中，W。为毽球机器人球拍的轴线距水平面的距禽，联立(13)及(16)，即可解得毽 球下一时刻落点的三维坐标P(Xp, yP, Zp)。
本发明的有益效果本发明的毽球机器人利用双目视觉系统完成对三维动态图像的采集， 利用优化的图像处理算法、动态目标的轨迹预估完成对三维动态目标的空间定位，再通过高 性能的电机伺服控制系统完成对机械设备的控制，实现毽球机器人对毽球连续、快速、精确 的击打动作。本发明的毽球机器人可适用于大学和科研院所等机器人研究开发机构，作为机 器视觉、伺服控制、人工智能等研究方向的实验平台。另外，本发明的毽球机器人可以作为 娱乐休闲设备，丰富人们的业余生活。
'
图1是本发明的毽球机器人的运行轨道部分的结构示意图； 图2是本发明的毽球机器人的击球部分的结构示意'图； 图3是本发明的毽球机器人的控制方法的流程图4是三维直角坐标系的建立及毽球在三维直角坐标系中的坐标点的位置的示意图。
其中，图1中，1—运行轨道部分，2—纵向轨道，3—纵向同步带，4一纵向滑块，5— 横向轨道，6—横向同步带，7—横向滑块，8—横向控制电机，9—底座，IO—纵向控制电机;
图2中，11—电机，12—击球部分，13—底板，14—蜗轮减速器，15—蜗轮减速器的轴， 16—球拍的轴，17—球拍。
具体实施例方式.
一种毽球机器人，包括运行轨道部分l、击球部分12及视觉部分，如图1所示，所述的 运行轨道部分1包括具有纵向轨道2的底座9，在纵向轨道2上设置有可在纵向轨道2上运 动的上方具有横向轨道5的纵向滑块4，在纵向滑块4的横向轨道5上设置有可在横向轨道5 上运动的横向滑块7;在纵向轨道2间、横向轨道5间分别设置有纵向同步带3、横向同步带 6，纵向同步带3、横向同步带6分别与底座9侧方的纵向控制电机10、横向控制电机8相连; 在横向滑块7上设置有所述的击球部分12，如图2所示，所述的击球部分12包括固定有球拍17的底板13，球拍17的轴16与电机11的蜗轮减速器14的轴15相连；所述的视觉部分 包括设置在毽球场地上方的与毽球机器人控制系统相连的两个互相垂直的摄像头；在轨道部 分1的纵向控制电机10、横向控制电机8及击球部分12的电机11内部设置有检测球拍17 角度及位置信息的传感器。
如图3所示，所述的毽球机器人的控制方法，包括如下步骤
使用前，首先需要对系统进行初始化设置，包括调整摄像头参数，测量毽球尺寸、场地 大小、摄像头高度，设定毽球亮度阚值，计算并保存场地信息查找表。毽球机器人对图像的 处理过程中会受到图片亮度的影响，不同的光照条件下同一个阈值会得到不同的二值化结果；
因此，需要根据每次的光照条件调整阈值，使得图像处理的结果能够较好地识别出毽球，进 而能够分析出毽球的信息，如面积、重心等。
步骤一通过两个互相垂直的摄像头采集两幅互相垂直的二维平面图像，并通过OPENCV 软件将采集到的二维平面图像进行二值化处理，得到两幅二值图像；最后在两幅二值图像中 提取出毽球的图像坐标，并对提取的毽球的图像坐标进行图像径向畸变和投影畸变的校正， 将毽球的图像坐标转换为相对于场地的实际坐标。
由于在实际当中有这些误差不可避免的存在摄像头与毽球场地不垂直、摄像头不在毽 球场地正上方等，使得投影畸变不可避免的发生。在建立场地信息查找表的过程中，投影畸 变校正是最为关键的技术。另外，广角镜头所带来的图像径向畸变，也必须加以校正。
所述的对图像坐标进行图像径向畸变和投影畸变的校正，将毽球的图像坐标转换为相对 于场地的实际坐标，具体实现过程如下
(1) 对两个互相垂直的摄像头所视毽球场地沿场地内沿分别加以标定，对垂直摄像头所 视毽球场地沿场地内沿取12个标定点，对平行摄像头所视毽球场地沿场地内沿取13个标定点； 以场地左上角为原点，测出标定点的实际坐标；并通过在图像中点击标定点得出标定点的图 像坐标；
(2) 利用径向畸变的多项式标定方法，建立实际坐标(xw， yw)与图像坐标(u， v)之 间的三次多项式关系
<formula>formula see original document page 11</formula>
(3) 根据步骤(1)中测出的标定点的实际坐标及图像坐标，利用最小二乘法解超定方
程组<formula>formula see original document page 11</formula>￡ [v, - (W" +…+Vw)] = 0
,=1 ,=1
"1 . (3)
其中，a々=0,l,2'..9)， W、0,l,2…9)为参数，求出a,(!'-0，1,2…9)， 6力'=0，1,2…9)的
值；即建立了图像坐标与实际坐标之间的映射关系； '
(4)根据步骤(3)中建立的图像坐标与实际坐标之间的映射关系，及步骤一中在两幅 二值图像中提取出的毽球的图像坐标，求出毽球相对于毽球场地的实际坐标。
步骤二如图4所示，根据两幅互相垂直的二值图像建立三维直角坐标系，在三维直角 坐标系中确定毽球在水平二值图像中的实际坐标P, (x1)yi， 0)及毽球在垂直二值图像中的实 际坐标P2(0,y2， z2);测得垂直摄像头在三维直角坐标系中的实际坐标Pc, (x山y。,，Zd)及水 平摄像头在三维直角坐标系中的实际坐标PC2(X。2，y。2,Z。2);连接h与P"，得到空间直线I^， 连接Pa与Pc2，得到空间直线U，空间直线L、 L2的公垂线段的中点Pt(Xt,yt，Zt)即为毽球在 三维直角坐标系中的坐标。
所述的毽球在三维直角坐标系中的坐标Pt(x" yt， zt)的具体计算过程如下
(1) 求取空间i线U、 L2的方程 空间直线L1:
x —、 y — h — Z —Zj
Ai-^ :^-a zcl-Zl ④
空间直线L2:
n2 =少-h = z-z2 (5)
义c2 — A 尺2 —少2 Zc2 —Z2
(2) 以距离平方和为目标函数的求取-
,MOdz,)"!2",:^^^2^:^,) (6)
其中，M(x,，少,，^为目标函数，"i，^分别为毽球在三维直角坐标系中的坐标Pt(Xt, yt， Zt)
距空间直线A，^的距离；
(3) 毽球在三维直角坐标系中的坐标Pt(xt, yt, Zt)的求得
步骤(2)中求取的目标函数M"'，y'A)为最小值时所对应的Xt，yt，Zt表示这样一个点
①他在两条空间直线L1、 L2的公垂线上；②他距两条空间直线L1、 L2的距离相等；即 为空间直线L1、 L2公垂线段的中点，也即为毽球在三维直角坐标系中的坐标Pt(Xt,yt,Zt)。对步骤(2)中求取的目标函数M"，^"分别求关于、，y'，z'的偏导数，联立成方程组
舰(W,，z,)
=0
0
(7)
求解此方程组，得到毽球在三维直角坐标系中的坐标Pt (Xt, yt， Zt)的坐标值。
步骤三对步骤二中求得的毽球在三维直角坐标系中的坐标Pt(xt, yt, zt)进行卡尔曼滤 波，得到一个滤波后的毽球在三维直角坐标系中的坐标Pt' (Xt， yt, zt)。
由于毽球属于不规则形状，因而其视觉识别与定位很难不出现扰动与误差，针对此问题 本发明采用卡尔曼滤波对毽球在三维直角坐标系中的坐标进行滤波处理。
步骤四通过力学分析得到毽球的轨迹运动方程；'再结合步骤三中得到的滤波后的毽球 在三维直角坐标系中的坐标Pt' (xt,yt,Zt)，用最小二乘法进行轨迹预估；预估得到毽球下一 时刻落点的三维坐标P(XP, yP， Zp)，并将该点的坐标传入信号控制系统。
所述的轨迹预估的具体过程如下
经过多次实验验证，采用公式(8)描述空气阻力模型是较为理想的
其中，k为毽球的固有参数，在空气密度基本不变的情况下与其体积及形状有关； 此外，毽球还受童力，
G, (9)
(10)
附
根据牛顿运动学定律，又有
1 2
2 (n)
v = v0+a, (12)
由于毽球是在三维空间内运动，现将毽球的运动分解为三个沿轴方向上运动的分量，综 合以上方程，最终得到毽球轨迹的运动方程x(f) = +
2卜
2/
2r
+ x0
+ y0
z(0 = vz0, + Oz0+^)--
一2r
以x方向为例:
(13)
-2卜十x。
A ，将其化为
一2jc響
(14)
结合步骤三中得到的滤波后的毽球在三维直角坐标系中的坐标Pt' (xt， yt, Zt)，.用最小二 乘法进行轨迹预估，得方程组
-"0(x, +-
1=0
_ —
2w
_2x.
)一a!]-(x,
2附
)=0
(15)
解此方程组，即得参数^，^的值；同理，求得y方向的参数6。,^的值，z方向的参数c。,q 的值，即得到了预估,线。
令方程(13)中的2") = 7/。 (16)
其中，^。为毽球机器人球拍的轴线距水平面的距离，联立(13)及(16)，即可解得毽 球下一时刻落点的三维坐标P(xp， yP， zp)。 '
步骤五通过设置在轨道部分及击球部分的电机内部的传感器，检测球拍的角度信息及
位置信息，并以电压信号传入信号控制系统；信号控制系统再结合步骤四中得到的毽球下一
时刻落点的三维坐标P(xp,yp，Zp)，计算出毽球机器人的运动量，并通过电机伺服控制系统控
制电机，完成毽球机器人沿轨道的运行及击球的动作；即由纵向控制电机及横向控制电机带
动击球部分在水平轨道部分运动，而后再控制击球部分的电机执行击球动作。
本发明的毽球机器人的电机伺服控制系统采用三菱电机伺服控制系统，由于该系统具有 高精度、高速度的特点，能够满足毽球机器人运动速度快、定位准的要求。该系统的控制器采用Q系列，更加高性能、小型化，从而实现高速的运动控制，具备多轴插补、速度控制、 软件凸轮定位、轨迹控制等运动控制功能。
权利要求
1、一种毽球机器人，其特征在于，包括运行轨道部分(1)、击球部分(12)及视觉部分，所述的运行轨道部分(1)包括具有纵向轨道(2)的底座(9)，在纵向轨道(2)上设置有可在纵向轨道(2)上运动的上方具有横向轨道(5)的纵向滑块(4)，在纵向滑块(4)的横向轨道(5)上设置有可在横向轨道(5)上运动的横向滑块(7)；在纵向轨道(2)间、横向轨道(5)间分别设置有纵向同步带(3)、横向同步带(6)，纵向同步带(3)、横向同步带(6)分别与底座(9)侧方的纵向控制电机(10)、横向控制电机(8)相连；在横向滑块(7)上设置有所述的击球部分(12)，所述的击球部分(12)包括固定有球拍(17)的底板(13)，球拍(17)的轴(16)与电机(11)的蜗轮减速器(14)的轴(15)相连；所述的视觉部分包括设置在毽球场地上方的与毽球机器人控制系统相连的两个互相垂直的摄像头；在轨道部分(1)的纵向控制电机(10)、横向控制电机(8)及击球部分(12)的电机(11)内部设置有检测球拍(17)角度及位置信息的传感器。
2、 权利要求1所述的毽球机器人的控制方法，其特征在于，包括如下步骤步骤一通过两个互相垂直的摄像头采集两幅互相垂直的二维平面图像，并通过OPENCV 软件将采集到的二维平面图像进行二值化处理，得到两幅二值图像；最后在两幅二值图像中 提取出毽球的图像坐标，并对提取的毽球的图像坐标进行图像径向畸变和投影畸变的校正， 将毽球的图像坐标转换为相对于场地的实际坐标；步骤二根据两幅互相垂直的二值图像建立三维直角坐标系，在三维直角坐标系中确定 毽球在水平二值图像中的实际坐标PAX" yi， O)及毽球在垂直二值图像中的实际坐标P2(0, y2， z2);测得垂直摄像头在三维直角坐标系中的实际坐标Pd (x￡l,yel，Zel)及水平摄像头在三维 直角坐标系中的实际坐标PC2(X。2，y。2，Z。2);连接P,与Pc;，得到空间直线L,,连接&与Pc2, 得到空间直线L2，空间直线L,、 L2的公垂线段的中点Pt(Xt，yt，Zt)即为毽球在三维直角坐标系 中的坐标；步骤三对步骤二中求得的毽球在三维直角坐标系中的坐标Pt(xt， yt， Zt)进行卡尔曼滤 波，得到一个滤波后的毽球在三维直角坐标系中的坐标Pt' (xt，yt，zt);步骤四通过力学分析得到毽球的轨迹运动方程；再结合步骤三中得到的滤波后的毽球 在三维直角坐标系中的坐标Pt' (xt,yt，zt)，用最小二乘法进行轨迹预估；预估得到毽球下一 时刻落点的三维坐标P(Xp， yP， Zp)，并将该点的坐标传入信号控制系统；步骤五通过设置在轨道部分及击球部分的电机内部的传感器，检测球拍的角度信息及 位置信息，并以电压信号传入信号控制系统；信号控制系统再结合步骤四中得到的'毽球下一 时刻落点的三维坐标P(Xp，yp,Zp)，计算出毽球机器人时运动量，并通过电机伺服控制系统控 制电机，完成毽球机器人沿轨道的运行及击球的动作；即由纵向控制电机及横向控制电机带动击球部分在水平轨道部分运动，而后再控制击球部分的电机执行击球动作。
3、根据权利要求2所述的毽球机器人的控制方法，其特征在于，所述的对图像坐标进行 图像径向畸变和投影畸变的校正，将毽球的图像坐标转换为相对于场地的实际坐标，具体实 现过程如下(1) 对两个互相垂直的摄像头所视毽球场地沿场地内沿分别加以标定，以场地左上角为 原点，测出标定点的实际坐标；并通过在图像中点击标定点得出标定点的图像坐标；(2) 利用径向畸变的多项式标定方法，建立实际坐标(Xw， yw)与图像坐标(u， v)之 间的三次多项式关系!_ >V =6。 +&1v + 62v2 +63v3 +64w + —v + 66ot2 +67w2 +6sm2v + 69w3 (i )(3) 根据步骤(1)中测出的标定点的实际坐标及图像坐标，利用最小二乘法解超定方程组S [X _ ("。 + " A! +…+ V』=0.￡[乂 _("。 + +Vw)ki =01=11] [y, - 0。 ++…+ )k = o "' (2)l;[x-(w;1+-+v』=o'￡[乂 - + V" V丄=0'=1Z [y, - (6。 + "+…+)k =0L'=' (3) 其中，",(/ = 0,l，2."9)， W"0,l,2…9)为参数，求出",(h0，1，2…9), 6力'=0,1,2…9)的值；即建立了图像坐标与实际坐标之间的映射关系；(4)根据步骤(3)中建立的图像坐标与实际坐标之间的映射关系，及步骤一中在两幅 二值图像中提取出的毽球的图像坐标，求出毽球相对于毽球场地的实际坐标。
4、根据权利要求2所述的毽球机器人的控制方法，其特征在于，所述的毽球在三维直角 坐标系中的坐标Pt (xt， yt， Zt)的具体计算过程如下 (1)求取空间直线L、 U的方程.-空间直线LI:x — _少一力 —z —^Ai一A (4)空间直线L2:.<formula>formula see original document page 4</formula>(2)以距离平方和为目标函数的求取 '<formula>formula see original document page 4</formula>其中，M(x,，^,z,)为目标函数，《，《分别为毽球在三维直角坐标系中的坐标Pt(xt, yt， zt)距空间直线^，^的距离； .(3 )毽球在三维直角坐标系中的坐标Pt (xt， yt， zt)的求得 对步骤(2)中求取的目标函数M"，y一')分别求关于、，^z'的偏导数，联立成方程组-<formula>formula see original document page 4</formula>求解此方程组，得到毽球在三维直角坐标系中的坐标Pt (xt， yt, zt)的坐标值。.
5、根据权利要求2所述的毽球机器人的控制方法，.其特征在于，所述的轨迹预估的具体过程如下-.建立空气阻力模型<formula>formula see original document page 4</formula>其中，k为毽球的固有参数，在空气密度基本不变的情况下与其体积及形状有关； 此外，毽球还受重力，<formula>formula see original document page 4</formula>附根据牛顿运动学k律，又有 .<formula>formula see original document page 4</formula>由于毽球是在三维空间内运动，现将毽球的运动分解为三个沿轴方向上运动的分量，综合以上方程，最终得到毽球轨迹的运动方程柳= f + 、o——2/--wg、+ 7。z(0 = vz0"Oz0 ++)以X方向为例:一2卜2附+ x0& ，将其化为(13)2w(14)结合步骤三中得到的滤波后的毽球在三维直角坐标系中的坐标Pt' (Xt， yt， Zt),用最小二 乘法进行轨迹预估，得方程组一 2、,=0—2x,2m'—2x,2w'(15)Z [y, _ a0+-- ^ ] = 0,=0.2a —2w'解此方程组，即得参数^，A的值；同理，求得y方向的参数6。,、的值，z方向的参数c。,c, 的值，即得到了预估曲线；令方程(13)中的20) = //。 (16)其中，Ho为毽球机器人球拍的轴线距水平面的距离，联立(13)及(16)，即可解得毽 球下一时刻落点的三维坐标P(Xp， yP， Zp)。
全文摘要
毽球机器人及控制方法属于机器人领域。本发明提供一种能够在三维空间活动的毽球机器人及控制方法。包括运行轨道部分、击球部分及视觉部分，在纵向轨道上设置有纵向滑块，在横向轨道上设置有横向滑块；纵向、横向同步带分别与电机相连；在横向滑块上设置有击球部分，球拍的轴与电机的轴相连；视觉部分包括两个互相垂直的摄像头；在电机内部设置有传感器。其控制方法采集图像进行二值化处理，提取毽球图像坐标，将毽球图像坐标转换为实际坐标；建立三维直角坐标系，求取毽球的三维坐标；对坐标进行卡尔曼滤波；进行轨迹预估；通过传感器检测球拍信息，与预估坐标一起传入信号控制系统，由伺服系统控制电机完成机器人沿轨道的运行及击球的动作。
文档编号B25J13/00GK101574586SQ200910011919
公开日2009年11月11日 申请日期2009年6月9日 优先权日2009年6月9日
发明者刘膑生, 原所先, 满永奎, 秦娜娜, 胡景新, 亮 赵 申请人:东北大学