一种激光跟踪仪控制系统及控制方法

摘要: 本发明涉及自动控制,具体涉及一种激光跟踪仪控制系统及控制方法。背景技术:1、激光跟踪仪在对空间运动目标进行测量时,需要控制驱动机构随目标位置变化进行运动,以保持...
一种激光跟踪仪控制系统及控制方法

本发明涉及自动控制,具体涉及一种激光跟踪仪控制系统及控制方法。

背景技术:

1、激光跟踪仪在对空间运动目标进行测量时,需要控制驱动机构随目标位置变化进行运动,以保持测量光对目标的持续跟踪。现有激光跟踪仪的驱动控制系统通常采用单一大扭矩伺服电机配合减速机构进行驱动,由同一驱动机构承担大范围转动和微小角度调节。当采用较大转矩满足快速跟踪需求时,电机较大的转动惯量以及减速机构产生的齿隙和弹性变形会影响微小角度调节精度;当降低运动速度以提高定位精度时,又难以及时响应快速移动的目标。

技术实现思路

1、本发明提供了一种激光跟踪仪控制系统及控制方法,以解决现有激光跟踪仪在动态跟踪过程中跟踪响应速度与跟踪精度难以兼顾的问题。

2、第一方面,本发明提供了一种激光跟踪仪控制系统,包括:

3、控制模块,包括数据缓冲器、水平驱动控制器和垂直驱动控制器,数据缓冲器包括缓冲处理器和双端口存储模块,双端口存储模块包括第一双端口随机存取存储器和第二双端口随机存取存储器,第一双端口随机存取存储器的两个访问端口分别与缓冲处理器和水平驱动控制器连接,第二双端口随机存取存储器的两个访问端口分别与缓冲处理器和垂直驱动控制器连接;

4、驱动模块,包括水平驱动模块和垂直驱动模块,水平驱动模块和垂直驱动模块均包括第一驱动单元和第二驱动单元,第一驱动单元的调节精度低于第二驱动单元的调节精度,水平驱动控制器分别与水平驱动模块的第一驱动单元和第二驱动单元连接,垂直驱动控制器分别与垂直驱动模块的第一驱动单元和第二驱动单元连接。

5、本发明通过第一双端口随机存取存储器和第二双端口随机存取存储器,使数据缓冲器分别与水平驱动控制器和垂直驱动控制器进行独立的数据交互,可减少两个方向控制数据传输过程中的等待和相互影响,提高控制数据的传输效率及驱动响应速度,水平和垂直方向均采用第一驱动单元和第二驱动单元提供不同的驱动能力,可在不同的调节阶段使用不同的驱动单元进行调节,有利于兼顾大范围跟踪响应和小角度调节精度,提高激光跟踪仪的动态跟踪性能。

6、在一种可选的实施方式中,水平驱动模块和垂直驱动模块均还包括转轴;

7、第一驱动单元包括直流力矩电机,直流力矩电机固定于对应的转轴;

8、第二驱动单元包括直线音圈电机、弹簧片、电磁铁和音圈电机驱动盘,直线音圈电机通过弹簧片与电磁铁连接,音圈电机驱动盘固定于对应的转轴,电磁铁用于在通电时吸附音圈电机驱动盘。

9、本实施方式中,直流力矩电机直接驱动转轴,可以提高转轴进行较大范围运动时的响应速度并减小传动误差;直线音圈电机通过电磁铁和音圈电机驱动盘对同一转轴进行微小角度调节,使转轴兼具较大范围转动能力和精细调节能力,有利于提高激光跟踪仪的动态跟踪速度和指向精度。

10、在一种可选的实施方式中,还包括工控机和轴角编码器,数据缓冲器还包括串口通信模块和第一指示信号模块,缓冲处理器通过串口通信模块分别与工控机及轴角编码器连接,第一指示信号模块与缓冲处理器连接。

11、本实施方式通过串口通信模块建立缓冲处理器与工控机、轴角编码器之间的两条通信通路,使缓冲处理器能够分别获取工控机传输的控制数据和轴角编码器反馈的轴角位置数据,并将处理后的数据提供给水平驱动控制器和垂直驱动控制器,有利于集中完成跟踪控制数据的获取和处理。

12、在一种可选的实施方式中,水平驱动控制器和垂直驱动控制器均包括驱动处理器、第二指示信号模块、电流环采集模块、光电隔离模块和功率驱动模块;

13、第二指示信号模块和电流环采集模块均与驱动处理器连接,驱动处理器与光电隔离模块连接,光电隔离模块与功率驱动模块连接,电流环采集模块和功率驱动模块均与对应的直流力矩电机或直线音圈电机连接。

14、本实施方式通过电流环采集模块向驱动处理器提供电机运行状态反馈,使驱动处理器能够根据实际电流状态调整电机控制;光电隔离模块对控制侧和功率侧进行隔离,功率驱动模块将控制信号转换为电机所需的驱动功率,有利于提高电机驱动过程的稳定性和抗干扰能力。

15、在一种可选的实施方式中,光电隔离模块包括光电耦合器,功率驱动模块包括栅极驱动芯片和h桥功率电路;

16、驱动处理器与光电耦合器连接,光电耦合器与栅极驱动芯片连接,栅极驱动芯片与h桥功率电路连接,h桥功率电路与对应的直流力矩电机或直线音圈电机连接。

17、本实施方式通过光电耦合器实现控制侧与功率侧之间的隔离传输,栅极驱动芯片为功率开关器件提供所需的驱动能力,h桥功率电路根据开关状态向电机输出相应的驱动电压,使控制信号能够可靠地转换为电机驱动力,有利于提高电机功率驱动的抗干扰能力和控制可靠性。

18、第二方面,本发明提供了一种激光跟踪仪控制方法,应用于上述第一方面或其对应的任一实施方式的激光跟踪仪控制系统,方法包括:

19、获取水平方向和垂直方向的跟踪偏差;

20、基于跟踪偏差,生成第一控制信号;

21、基于第一控制信号,并行控制水平方向和垂直方向对应的第一驱动单元运行;

22、在水平方向或垂直方向的跟踪偏差减小至预设阈值时,生成第二控制信号;

23、基于第二控制信号,控制对应的第一驱动单元降低或停止输出,并控制对应的第二驱动单元运行。

24、本发明通过水平方向和垂直方向的独立并行控制,可以对空间目标运动引起的水平角变化和垂直角变化进行协调调整;通过根据跟踪偏差在第一控制阶段和第二控制阶段之间进行转换,可以在不同调节阶段由不同调节精度的驱动单元承担角度控制,从而兼顾较大范围跟踪时的响应速度和接近目标位置后的角度调节精度。

25、在一种可选的实施方式中,第一控制信号和第二控制信号均包括对应的电机驱动信号,电机驱动信号的生成过程包括:

26、获取对应电机的电流反馈以及对应轴角编码器速度反馈和位置反馈;

27、基于电流反馈、速度反馈和位置反馈,对对应的跟踪偏差进行电流环、速度环和位置环校正,得到校正结果;

28、基于校正结果进行增量式pi调节,生成双极性脉宽调制信号,并将双极性脉宽调制信号作为电机驱动信号。

29、本实施方式通过电流、速度和位置三类反馈信息对电机控制过程进行闭环校正,并采用增量式pi调节生成双极性脉宽调制信号,使第一控制阶段和第二控制阶段均能够结合电机和转轴的实际状态持续调整控制输出。双极性脉宽调制可以实现电机正反向控制,并可以在平均电压接近零时维持高频微振动状态,有利于提高低速运行的平稳性和微小位置调节精度。

30、在一种可选的实施方式中,基于校正结果进行增量式pi调节,生成双极性脉宽调制信号,包括:

31、根据第一预设公式确定第k个控制周期的控制量增量δu(k),第一预设公式为:

32、δu(k)=kp·[e(k)-e(k-1)]+ki·e(k)

33、根据第二预设公式确定第k个控制周期的控制量u(k),第二预设公式为:

34、u(k)=u(k-1)+δu(k)

35、其中,e(k)为第k个控制周期的校正结果,e(k-1)为第k-1个控制周期的校正结果,u(k-1)为第k-1个控制周期的控制量,kp为比例系数,ki为积分系数;

36、基于第k个控制周期的控制量u(k)生成双极性脉宽调制信号。

37、本发明通过上述增量式pi调节,可以根据连续控制周期的校正结果更新控制量,并据此生成双极性脉宽调制信号,有利于提高电机驱动控制的响应性,减小稳态误差。

38、在一种可选的实施方式中,基于第二控制信号,控制对应的第一驱动单元降低或停止输出,并控制对应的第二驱动单元运行,包括:

39、基于第二控制信号,控制电磁铁上电,使电磁铁吸附于固定在对应的转轴上的音圈电机驱动盘;

40、控制对应的直流力矩电机降低或停止输出,并控制对应的直线音圈电机运行,通过音圈电机驱动盘驱动对应的转轴转动。

41、本实施方式在第二驱动单元介入时,通过电磁铁吸附音圈电机驱动盘建立直线音圈电机与转轴之间的传力关系,并降低或切断直流力矩电机的输出,使较大范围驱动逐步转由精细驱动承担,可以减少两级驱动在切换阶段对同一转轴的相互影响,使转轴由较大范围运动平稳过渡至微小角度调节。

42、在一种可选的实施方式中,获取水平方向和垂直方向的跟踪偏差,包括:

43、获取水平方向和垂直方向的跟踪数据,跟踪数据包括位置偏差信号、目标位置数据和轴角位置数据中的一种或几种;

44、将水平方向的跟踪数据写入第一双端口随机存取存储器,并将垂直方向的跟踪数据写入第二双端口随机存取存储器;

45、基于水平方向和垂直方向的跟踪数据,分别确定水平方向跟踪偏差和垂直方向跟踪偏差;

46、其中,激光跟踪仪的工作模式包括动态跟踪模式和定点位置跟踪模式;在动态跟踪模式下,跟踪数据包括位置偏差信号;在定点位置跟踪模式下,跟踪数据包括目标位置数据和轴角位置数据。

47、本实施方式通过上述数据分配方式,水平方向和垂直方向的数据可以分别在对应的双端口随机存取存储器中更新,并由两个驱动控制器独立读取。两个方向可以共享数据更新时间基准并按照各自控制周期独立并行执行,从而实现对空间目标水平角变化和垂直角变化的协调跟踪。