一种控制FPC连接器插针的方法和系统与流程

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

技术特征:

1.一种控制FPC连接器插针的方法,其特征在于,所述方法包括:

设置一主轴电机、一拨料电机和一步进电机;

根据一个FPC连接器待插针个数预先设定所述主轴电机的转动周期数,并在所述主轴电机的转动周期内,预先设定控制所述拨料电机动作对应的第一角度范围和控制所述步进电机动作对应的第二角度范围,其中所述第一角度范围与所述第二角度范围无重叠;

当一个待插针FPC连接器送到待插针位置后,控制所述主轴电机启动转动,并设置一插针数量变量,所述插针数量变量的初始值为0;

在所述主轴电机的每一个转动周期内,实时检测所述主轴电机的转动角度:

当检测到所述主轴电机的转动角度到达所述第一角度范围时,控制所述拨料电机从插针料带中取下一个插针,对应所述FPC连接器上的一个待插针位置完成一个插针;当检测到所述主轴电机的转动角度到达所述第二角度范围时,控制所述步进电机将所述FPC连接器步进一个插针的距离到下一个待插针位置;

将所述插针数量变量加1,判断所述插针数量变量是否等于预先设定的所述主轴电机的转动周期数;若判断为是,则判断一个FPC连接器插针结束;若判断为否,则控制所述主轴电机继续转动,重复所述主轴电机下一个转动周期的检测控制。

2.根据权利要求1所述的方法,其特征在于,在判断一个FPC连接器插针完成之后,所述方法进一步包括:

控制所述步进电机将插针结束的FPC连接器送到拨料后位,并返回到拨料前位取料,将经过插针底座和扣盖组装后的下一个待插针FPC连接器送到待插针位置,继续下一个FPC连接器插针的控制;直至所有待插针FPC连接器全部插针完成,控制所述主轴电机停止转动。

3.根据权利要求2所述的方法,其特征在于,所述在所述主轴电机的每一个转动周期内,实时检测所述主轴电机的转动角度包括:

获取所述主轴电机的一个转动周期的编码器分频脉冲数;

设置一环形高速计数器,并将所述环形高速计数器旋转一圈的脉冲数设置成同于所述主轴电机的一个转动周期的编码器分频脉冲数;

根据所述环形高速计数器的脉冲数实时检测所述主轴电机的转动角度,以及在所述主轴电机完成一个转动周期后,将所述环形高速计数器的脉冲数值清零。

4.根据权利要求3所述的方法,其特征在于,所述在所述主轴电机的每个转动周期内,预先设定控制所述拨料电机动作对应的第一角度范围和控制所述步进电机动作对应的第二角度范围包括:

根据所述主轴电机的一个转动周期的编码器分频脉冲数,将所述第一角度范围的起始值转化为相应的第一脉冲数,将所述第二角度范围的起始值转化为相应的第二脉冲数;

设置一高速计数比较器,并将所述第一脉冲数和所述第二脉冲数存储在所述高速计数比较器中;

当所述环形高速计数器的脉冲数等于所述高速计数器比较器存储的所述第一脉冲数时,向所述拨料电机发送中断信号,控制所述拨料电机进行相应动作;

当所述环形高速计数器的脉冲数等于所述高速计数器比较器存储的所述第二脉冲数时,向所述步进电机发送中断信号,控制所述步进电机进行相应动作。

5.根据权利要求1-4任一项所述的方法,其特征在于,所述方法还包括:

调整所述主轴电机、所述拨料电机和所述步进电机的增益值,和/或,调整所述主轴电机、所述拨料电机和所述步进电机的速度环增益、速度环积分时间常数、位置环增益、转动惯量比,以平滑稳定各电机动作时的位置偏差和反馈速度,减少插针时对FPC连接器的划伤。

6.一种控制FPC连接器插针的系统,其特征在于,所述系统包括:一控制主机、一主轴电机、一拨料电机和一步进电机;其中,

所述主轴电机,用于转动,根据转动的角度范围,控制所述拨料电机和所述步进电机之间的动作时序;

所述拨料电机,用于从插针料带中取下一个插针,对应所述FPC连接器上的一个待插针位置完成一个插针;

所述步进电机,用于将所述FPC连接器步进一个插针的距离到下一个待插针位置;

所述控制主机,包括:

预先设定单元,用于根据一个FPC连接器待插针个数预先设定所述主轴电机的转动周期数,并在所述主轴电机的转动周期内,预先设定控制所述拨料电机动作对应的第一角度范围和控制所述步进电机动作对应的第二角度范围,其中所述第一角度范围与所述第二角度范围无重叠;

主轴电机控制单元,用于当一个待插针FPC连接器送到待插针位置后,控制所述主轴电机启动转动;当一个待插针FPC连接器未结束插针时,控制所述主轴电机继续转动;以及当所有待插针FPC连接器全部插针结束时,控制所述主轴电机停止转动;

插针计数单元,用于设置一插针数量变量,所述插针数量变量的初始值为0;每完成一个插针,将所述插针数量变量加1;

检测控制单元,用于在所述主轴电机的每一个转动周期内,实时检测所述主轴电机的转动角度:当检测到所述主轴电机的转动角度到达所述第一角度范围时,控制所述拨料电机完成相应动作;当检测到所述主轴电机的转动角度到达所述第二角度范围时,控制所述步进电机完成相应动作;

判断控制单元,用于判断所述插针数量变量是否等于预先设定的所述主轴电机的转动周期数;若判断为是,则判断一个FPC连接器插针结束;若判断为否,则由所述主轴电机控制单元控制所述主轴电机继续转动,并返回所述检测控制单元,重复所述主轴电机下一个转动周期的检测控制。

7.根据权利要求6所述的系统,其特征在于,

所述步进电机,还用于将插针结束的FPC连接器送到拨料后位,并返回到拨料前位取料,将经过插针底座和扣盖组装后的下一个待插针FPC连接器送到待插针位置;

所述控制主机还包括循环控制单元,

所述循环控制单元,用于在所述判断控制单元判断一个FPC连接器插针完成之后,控制所述步进电机进一步动作,将下一个待插针FPC连接器送到待插针位置,并继续下一个FPC连接器插针的控制;直至所有待插针FPC连接器全部插针完成,由所述主轴电机控制单元控制所述主轴电机停止转动。

8.根据权利要求7所述的系统,其特征在于,所述系统还包括一环形高速计数器,所述环形高速计数器旋转一圈的脉冲数设置成同于所述主轴电机的一个转动周期的编码器分频脉冲数;

检测控制单元具体用于,根据所述环形高速计数器的脉冲数实时检测所述主轴电机的转动角度,以及在所述主轴电机完成一个转动周期后,将所述环形高速计数器的脉冲数值清零。

9.根据权利要求8所述的系统,其特征在于,所述系统还包括一高速计数比较器,

所述预先设定单元具体用于,根据所述主轴电机的一个转动周期的编码器分频脉冲数,将所述第一角度范围的起始值转化为相应的第一脉冲数,将所述第二角度范围的起始值转化为相应的第二脉冲数;以及将所述第一脉冲数和所述第二脉冲数存储在所述高速计数比较器中;

所述检测控制单元还具体用于,当所述环形高速计数器的脉冲数等于所述高速计数器比较器存储的所述第一脉冲数时,向所述拨料电机发送中断信号,控制所述拨料电机进行相应动作;当所述环形高速计数器的脉冲数等于所述高速计数器比较器存储的所述第二脉冲数时,向所述步进电机发送中断信号,控制所述步进电机进行相应动作。

10.根据权利要求6-9任一项所述的系统,其特征在于,所述系统还包括:调整单元,用于调整所述主轴电机、所述拨料电机和所述步进电机的增益值,和/或,调整所述主轴电机、所述拨料电机和所述步进电机的速度环增益、速度环积分时间常数、位置环增益、转动惯量比,以平滑稳定各电机动作时的位置偏差和反馈速度,减少插针时对FPC连接器的划伤。

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