一种伺服驱动系统及其断电位置控制方法
【技术领域】
[0001]本发明涉及伺服驱动系统领域，尤其涉及一种伺服驱动系统及其断电位置控制方法。
【背景技术】
[0002]在一些伺服驱动器驱动伺服电机的应用场合，不可以避免会出现意外断电的情形，此时，需要把伺服电机及时停住，而且停在适当位置，下一次上电从此位置继续工作。比如横机(针织机的一种)就需要具有断电续织功能，一件衣服没有织完，如果突然断电，则需要在恢复供电时能够在原位置重新开始工作，否则会造成很大的损失。
[0003]伺服驱动电机在工作时，如果遇到电网突发断电(即伺服驱动器主电源断电)，则伺服电机还会继续转动，直到欠压停止转动，但此时停止位置是不可控的。且由于伺服电机使用的是增量式编码器，不知何时断电，当伺服驱动器电源重新上电后，上次断电时的电机位置没有保存下来，则伺服驱动器会认为当前伺服电机的位置为初始位置(O位置)。
[0004]现有的技术中，在伺服驱动系统中增加一个不间断电源(Uninterruptible PowerSupply, UPS)，在电网断电后仍可维持伺服驱动系统工作一段时间，使伺服电机在初始位置(O位置)停止。但是现有的UPS电源一般比较昂贵，这样会增加伺服驱动系统的成本。
【发明内容】
[0005]鉴于现有技术的不足，本发明实施例一种伺服驱动系统及其断电位置控制方法，在主电源突然断电时，可以精确控制伺服电机继续运动一个确定的距离，并保存该距离信息，安全可靠且可降低成本。
[0006]为了达到上述发明目的，本发明实施例提供了一种伺服驱动系统断电位置控制方法，所述方法包括如下步骤:
当检测到所述伺服驱动系统的主三相电源断电时，获得伺服电机的编码器的当前编码器反馈值；
根据所述当前编码器反馈值计算获得一给定位置；
在具有延时功能的控制电源的控制下，所述伺服驱动系统中的伺服驱动器驱动所述伺服电机继续运动，运动至所述给定位置并停机；
获得所述给定位置所对应的编码器反馈值，并存储。
[0007]优选地，进一步包括:
当所述伺服驱动系统的主三相电源恢复供电后，获得所述存储的编码器反馈值所对应的给定位置信息，并控制所述伺服电机从所述给定位置继续工作。
[0008]优选地，所述根据所述当前编码器反馈值计算获得一给定位置的步骤进一步包括:
根据所述当前编码器反馈值与初始位置的关系，确定所述伺服电机的旋转方向；
根据当前编码器反馈值以及与旋转方向相对应的预定的公式，计算获得给定位置，所述预定公式为:
A=[取整(x/k) 土i]*k
其中，A为给定位置，X为断电瞬间的当前编码器反馈值，k为第一整数，i为第二整数；当伺电机的旋转方向为逆时针时，公式中取“ + ”，当伺电机的旋转方向为逆时针时，公式中取
[0009]优选地，所述根据所述当前编码器反馈值计算获得一给定位置的步骤进一步包括:
根据所述当前编码器反馈值与初始位置的关系，确定所述伺服电机的旋转方向；
根据当前编码器反馈值以及与旋转方向相对应的预定的公式，计算获得给定位置，所述预定公式为:
A=X 土 Δ
其中，A为给定位置，X为断电瞬间的当前编码器反馈值，△为一固定值，当伺电机的旋转方向为逆时针时，公式中取“ + ”，当伺电机的旋转方向为逆时针时，公式中取“
[0010]优选地，根据所述当前编码器反馈值与初始位置的关系，确定所述伺服电机的旋转方向的步骤具体为:
将所述当前编码器反馈值与初始位置进行比较；
如果所述当前编码器反馈值大于所述初始位置，则判定所述伺服电机的旋转方向为逆时针；
如果所述当前编码器反馈值小于所述初始位置，则判定所述伺服电机的旋转方向为顺时针。
[0011]相应地，本发明实施例的另一方面还提供了一种伺服驱动系统，其包括伺服驱动器和伺服电机，所述伺服电机中设置有编码器，其所述伺服驱动器进一步包括:
断电检测单元，用于检测与所述伺服驱动器连接的主三相电源是否断电；
反馈值获得单元，用于从所述编码器获得编码器反馈值；
给定位置获得单元，用于在断电检测单元检测到主三相电源断电时，根据所述反馈值获得单元所获得的当前编码器反馈值，计算获得一给定位置；
驱动单元，用于在具有延时功能的控制电源的控制下，驱动所述伺服电机继续运动，运动至所述给定位置并停机；
存储单元，用于存储所述伺服电机运动到所述给定位置时所述编码器所反馈的编码器反馈值。
[0012]优选地，进一步包括:
续电控制单元，用于在所述伺服驱动系统的主三相电源恢复供电后，根据所述存储的编码器反馈值所对应的给定位置信息，控制所述伺服电机从所述给定位置继续工作。
[0013]优选地，所述给定位置获得单元进一步包括:
旋转方向判断单元，用于根据所述当前编码器反馈值与初始位置的关系，确定所述伺服电机的旋转方向；
计算单元，用于根据当前编码器反馈值以及与旋转方向相对应的预定的公式，计算获得给定位置，所述预定公式为:
A=[取整(x/k) 土i]*k 其中，A为给定位置，X为断电瞬间的当前编码器反馈值，k为第一整数，i为第二整数；当伺电机的旋转方向为逆时针时，公式中取“ + ”，当伺电机的旋转方向为逆时针时，公式中取
[0014]优选地，所述给定位置获得单元进一步包括:
旋转方向判断单元，用于根据所述当前编码器反馈值与初始位置的关系，确定所述伺服电机的旋转方向；
计算单元，用于根据当前编码器反馈值以及与旋转方向相对应的预定的公式，计算获得给定位置，所述预定公式为:
A=X 土 Δ
其中，A为给定位置，X为断电瞬间的当前编码器反馈值，△为一固定值，当伺电机的旋转方向为逆时针时，公式中取“ + ”，当伺电机的旋转方向为逆时针时，公式中取“
[0015]优选地，所述旋转方向判断单元具体通过下述方式确定伺服电机的旋转方向: 将所述当前编码器反馈值与初始位置进行比较；
如果所述当前编码器反馈值大于所述初始位置，则判定所述伺服电机的旋转方向为逆时针；
如果所述当前编码器反馈值小于所述初始位置，则判定所述伺服电机的旋转方向为顺时针。
[0016]实施本发明实施例，具有如下有益效果:
本发明实施例提供的技术方案，通过在检测到主电源断电后，根据此时的当前编码器反馈值，计算获得一个确定的给定位置，通过具有延时功能的控制电源，伺服系统的驱动电路控制伺服电机继续运转至该给定位置并停机，且存储该给定位置信息，从而可以在主电源恢复供电后，控制该伺服电机从该给定位置继续开始工作；这样，在电源断电时，该伺服电机的停止位置是确定，从而可以精确地控制伺服电机重新启动的位置，保证了工作的连续性；
实施本发明实施例提供的技术方案，安全可靠，且无需现有技术中的UPS电源，可以显著降低系统成本。
【附图说明】
[0017]为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
[0018]图1是本发明提供的一种伺服驱动系统的断电位置控制方法一个实施例的流程示意图；
图2是本发明提供的一种伺服驱动系统一个实施例的结构示意图；
图3是图2中给定位置获得单元的一个实施例的结构示意图。
【具体实施方式】
[0019]下面结合附图对本发明的实施例进行详见说明。
[0020]如图1所示，是本发明提供的一种伺服驱动系统的断电位置控制方法一个实施例，在该实施例中，该伺服驱动系统的断电位置控制方法用于在伺服驱动系统突然断电时，控制伺服电机继续转动至一特定的位置，该方法包括如下步骤:
步骤S10，当检测到伺服驱动系统的主三相电源(AC电源)断电时，获得伺服电机的编码器的当前编码器反馈值；
步骤S12，根据当前编码器反馈值计算获得一给定位置。
[0021]其中，步骤S12进一步包括:
根据当前编码器反馈值与初始位置的关系，确定伺服电机的旋转方向，具体地，将当前编码器反馈值与初始位置(如O值)进行比较；如果当前编码器反馈值大于初始位置，则判定伺服电机的旋转方向为逆时针；如果当前编码器反馈值小于初始位置，则判定伺服电机的旋转方向为顺时针；
根据当前编码器反馈值以及与旋转方向相对应的预定的公式，计算获得给定位置，预定公式为:
A=[取整(x/k) 土i]*k
其中，A为给定位置，X为断电瞬间的当前编码器反馈值，k为第一整数，i为第二整数；当伺电机的旋转方向为逆时针时，公式中取“ + ”，当伺电机的旋转方向为逆时针时，公式中取
[0022]例如在一个例子中，对K取值为288，对i取值为10，则在上式中，该给定位置A =[取整(X / 288 ) ± 10 ] * 288，其结果为288的整数倍位置；
步骤S122，在具有延时功能的控制电源(DC)的控制下，伺服驱动系统中的伺服驱动器驱动伺服电机继续运动，运动至给定位置并停机，其中，具有延时功能的控制电源可以通过多种方式实现，例如，在一些实施例中，可以直接通过伺服母线电容电量的缓慢放电来实现，或者也可以通过类似的延时电路来实现，在此不进行详述；
步骤S124，获得给定位置所对应的编码器反馈值，并存储。
[0023]步骤S126，当伺服驱动系统的主三相电源恢复供电后，获得存储的编码器反馈值所对应的给定位置信息，并控制伺服电机从给定位置继续工作。
[0024]可以理解的是，在步骤S12中的公式中，该K与i是预先设定好的，例如可以通过不断实验得出该两个值，此处注意需保证通过该公式算出的给定位置A需小于伺服电机在断电后所能运行的最大位置L，以便能控制该伺服电机停止