机械臂关节的控制系统以及控制方法与流程

文档序号:11913648阅读:来源:国知局

技术特征:

1.一种机械臂关节的控制系统,所述控制系统包括减速机构、控制器以及与所述控制器连接的增量式编码器和旋转电位器;

所述减速机构包括输入端和输出端,所述减速机构的输出端与所述关节相连接,且所述减速机构的输出端与所述关节中任一可以被另一个驱动;

所述增量式编码器用以根据所述减速机构的输入端的转动状态输出第一信号至所述控制器;

所述旋转电位器用以根据所述减速机构的输出端的转动状态输出第二信号至所述控制器;

所述控制器根据所述第一信号和第二信号获取上电时所述减速机构的输入端的绝对角度的精确值,并根据所述第一信号以及上电时所述减速机构的输入端的绝对角度的精确值,获得上电后所述关节的绝对角度的精确值,以控制所述关节的运动。

2.根据权利要求1所述的机械臂关节的控制系统,其特征在于,所述第一信号包括所述增量式编码器中A相、B相以及C相的脉冲信号,所述控制器根据所述脉冲信号得到上电时所述减速机构的输入端的相对角度的精确值,所述第二信号包括所述旋转电位器的电压信号,所述控制器根据所述电压信号得到上电后所述减速机构的输出端的绝对角度的粗略值。

3.根据权利要求2所述的机械臂关节的控制系统,其特征在于,

所述控制器根据所述第一信号和第二信号获取上电时所述减速机构的输入端的绝对角度的精确值的过程包括:

上电时,所述控制器根据所述第二信号中所述旋转电位器的电压信号获取上电时减速机构的输出端的绝对角度的粗略值;

上电后,所述减速机构的输入端转动至所述控制器接收到所述增量式编码器的第一个C相脉冲信号时,所述控制器根据此时的增量式编码器的A相以及B相的脉冲信号以得到上电时增量式编码器的C相偏转角度;

然后,所述控制器根据所述上电时减速机构的输出端的绝对角度的粗略值、所述上电时增量式编码器的C相偏转角度以及减速机构的减速比,获取上电时所述减速机构的输入端的绝对角度的精确值。

4.根据权利要求3所述的机械臂关节的控制系统,其特征在于,

上电后所述减速机构的输入端的绝对角度的精确值的计算如下:

θH0=int(θL0*i/360°)*360°+Δθ0

其中,θH0为上电时所述减速机构的输入端的绝对角度的精确值,以角度制度量;int()为向下取整函数;i为预设的减速机构的减速比,且i为大于1的正数;θL0为上电时所述减速机构的输出端的绝对角度的粗略值;Δθ0为上电时所述增量式编码器的C相偏转角度。

5.根据权利要求2所述的机械臂关节的控制系统,其特征在于,所述控制器根据上电时所述减速机构的输入端的绝对角度的精确值、所述增量式编码器中A相以及B相的脉冲信号,获得上电后所述减速机构的输入端的绝对角度的精确值。

6.根据权利要求1所述的机械臂关节的控制系统,其特征在于,所述减速机构的输入端为一主动轮,所述减速机构的输出端为一从动轮,所述主动轮和从动轮通过牵引体传动连接;所述从动轮与所述关节同轴转动或通过一传动机构连接,所述旋转电位器与所述从动轮同轴转动;所述增量式编码器与所述主动轮同轴转动。

7.根据权利要求1所述的机械臂关节的控制系统,其特征在于,所述控制系统还包括一驱动电机,所述驱动电机与减速机构的输入端机械连接,以驱动减速机构的输入端转动,所述控制器与驱动电机电连接,以控制驱动电机的转动。

8.一种机械臂关节的控制方法,其特征在于,包括:

一增量式编码器用以根据所述减速机构的输入端的转动状态输出第一信号至控制器;

一旋转电位器用以根据所述减速机构的输出端的转动状态输出第二信号至所述控制器;

所述控制器根据所述第一信号和第二信号获取上电时所述减速机构的输入端的绝对角度的精确值,并根据所述第一信号以及上电后所述减速机构的输入端的绝对角度的精确值,获得上电后所述关节的绝对角度的精确值,以控制所述关节的运动。

9.根据权利要求8所述的机械臂关节的控制方法,其特征在于,所述第一信号包括所述增量式编码器中A相、B相以及C相的脉冲信号,所述控制器根据所述脉冲信号得到上电时所述减速机构的输入端的相对角度的精确值,所述第二信号包括所述旋转电位器的电压信号,所述控制器根据所述电压信号得到上电后所述减速机构的输出端的绝对角度的粗略值。

10.根据权利要求9所述的机械臂关节的控制方法,其特征在于,所述控制器根据所述第一信号和第二信号获取上电时所述减速机构的输入端的绝对角度的精确值的过程包括:

上电时,所述控制器根据所述第二信号中所述旋转电位器的电压信号获取上电时所述减速机构的输出端的绝对角度的粗略值;

上电后,所述减速机构的输入端转动至所述控制器接收到所述增量式编码器的第一次C相脉冲信号时,所述控制器根据此时的增量式编码器A相以及B相的脉冲信号以得到上电时增量式编码器的C相偏转角度;

然后,所述控制器根据所述上电时减速机构的输出端的绝对角度的粗略值、所述上电时增量式编码器的C相偏转角度以及预设的减速机构的减速比,获取上电时所述减速机构的输入端的绝对角度的精确值。

11.根据权利要求10所述的机械臂关节的控制方法,其特征在于,

上电时所述减速机构的输入端的绝对角度的精确值的计算如下:

θH0=int(θL0*i/360°)*360°+Δθ0

其中,θH0为上电时所述减速机构的输入端的绝对角度的精确值,以角度制度量;int()为向下取整函数;i为预设的减速机构的减速比,且i为大于1的正数;θL0为上电时所述减速机构的输出端的绝对角度的粗略值;Δθ0为上电时所述增量式编码器的C相偏转角度。

12.根据权利要求9所述的机械臂关节的控制方法,其特征在于,所述控制器根据上电时所述减速机构的输入端的绝对角度的精确值、所述增量式编码器中A相以及B相的脉冲信号,获得上电后所述减速机构的输入端的绝对角度的精确值。

13.根据权利要求9所述的机械臂关节的控制方法,其特征在于,所述控制方法还包括上电后校验增量式编码器的步骤:

上电后,所述控制器根据所述第二信号获取上电后所述减速机构的输出端的绝对角度的粗略值,并根据所述第一信号获取所述增量式编码器的A相以及B相的脉冲信号,以及上电时所述减速机构的输入端的绝对角度的精确值以及预设的减速机构的减速比,判断所述控制系统是否工作正常。

14.根据权利要求13所述的机械臂关节的控制方法,其特征在于,

判断公式为|θHL*i|>360°,

其中,θL为上电后所述减速机构的输出端的绝对角度的粗略值,以角度制度量;θH为上电后所述减速机构的输入端的绝对角度的精确值,以角度制度量;θH为根据增量式编码器的A相、B相的脉冲信号以及上电时所述减速机构的输入端的绝对角度的精确值得到;其中,

若满足公式,则所述控制器判定所述控制系统工作不正常;

若不满足公式,则所述控制器判定所述控制系统工作正常。

当前第2页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1