【技术实现步骤摘要】
本专利技术实施例属于音圈电机控制
,尤其涉及一种音圈电机控制方法、系统及控制器。
技术介绍
音圈电机因其具有高频响、高精度等特点,而广泛应用于信号频率较高的太赫兹时域光谱仪的光学延迟装置中。然而,目前的光学延迟装置通常采用模拟信号对音圈电机进行闭环控制,模拟信号,易受到音圈电机的电磁反射及机械振动的干扰,可靠性较低,而且外围电路较复杂。
技术实现思路
本专利技术实施例提供一种音圈电机控制方法、系统及控制器,采用数字信号对音圈电机进行闭环控制,可避免受到音圈电机的电磁反射及机械振动的干扰,可靠性高,而且外围电路简单。本专利技术实施例一方面提供一种音圈电机控制方法,所述音圈电机与驱动电路电连接并与位移传感器机械连接,所述驱动电路和所述位移传感器均与控制器电连接,所述音圈电机控制方法包括由所述控制器执行的以下操作:若接收到上电启动指令,则输出两路第一预设占空比的脉宽调制信号控制所述驱动电路输出第一预设电流信号,以驱动所述音圈电机以第一速度向第一方向运动;检测所述位移传感器输出的零点信号是否为高电平信号,所述零点信号用于表征所述音圈电机是否到达预设零点位置;若所述零点信号为高电平信号,则输出两路第二预设占空比的脉宽调制信号控制所述驱动电路输出第二预设电流信号,以控制所述音圈电机以第二速度向第二方向运动;从预设初始数值开始对所述位移传感器输出的脉冲个数进行计数,并检测所述脉冲个数是否到达预设个数;若所述脉冲个数到达预设个数,则控制所述驱动电路改变所述第二预设电流信号的方向,并检测所述音圈电机是否沿所述第一方向运动;若所述音圈电机沿所述第一方向运动,则对所述位移传 ...
【技术保护点】
一种音圈电机控制方法,其特征在于,所述音圈电机与驱动电路电连接并与位移传感器机械连接,所述驱动电路和所述位移传感器均与控制器电连接,所述音圈电机控制方法包括由所述控制器执行的以下操作:若接收到上电启动指令,则输出两路第一预设占空比的脉宽调制信号控制所述驱动电路输出第一预设电流信号,以驱动所述音圈电机以第一速度向第一方向运动;检测所述位移传感器输出的零点信号是否为高电平信号,所述零点信号用于表征所述音圈电机是否到达预设零点位置;若所述零点信号为高电平信号,则输出两路第二预设占空比的脉宽调制信号控制所述驱动电路输出第二预设电流信号,以控制所述音圈电机以第二速度向第二方向运动;从预设初始数值开始对所述位移传感器输出的脉冲个数进行计数,并检测所述脉冲个数是否到达预设个数;若所述脉冲个数到达预设个数,则控制所述驱动电路改变所述第二预设电流信号的方向,并检测所述音圈电机是否沿所述第一方向运动;若所述音圈电机沿所述第一方向运动,则对所述位移传感器输出的脉冲个数进行逆计数,将已计数数值清零并停止计数,直到再次检测到所述零点信号为高电平信号时,返回所述输出两路第二预设占空比的脉宽调制信号的操作。
【技术特征摘要】
1.一种音圈电机控制方法,其特征在于,所述音圈电机与驱动电路电连接并与位移传感器机械连接,所述驱动电路和所述位移传感器均与控制器电连接,所述音圈电机控制方法包括由所述控制器执行的以下操作:若接收到上电启动指令,则输出两路第一预设占空比的脉宽调制信号控制所述驱动电路输出第一预设电流信号,以驱动所述音圈电机以第一速度向第一方向运动;检测所述位移传感器输出的零点信号是否为高电平信号,所述零点信号用于表征所述音圈电机是否到达预设零点位置;若所述零点信号为高电平信号,则输出两路第二预设占空比的脉宽调制信号控制所述驱动电路输出第二预设电流信号,以控制所述音圈电机以第二速度向第二方向运动;从预设初始数值开始对所述位移传感器输出的脉冲个数进行计数,并检测所述脉冲个数是否到达预设个数;若所述脉冲个数到达预设个数,则控制所述驱动电路改变所述第二预设电流信号的方向,并检测所述音圈电机是否沿所述第一方向运动;若所述音圈电机沿所述第一方向运动,则对所述位移传感器输出的脉冲个数进行逆计数,将已计数数值清零并停止计数,直到再次检测到所述零点信号为高电平信号时,返回所述输出两路第二预设占空比的脉宽调制信号的操作。2.如权利要求1所述的音圈电机控制方法,其特征在于,所述位移传感器为光栅式位移传感器,所述零点位置为所述光栅式位移传感器的光栅尺上的零点刻线位置。3.如权利要求1所述的音圈电机控制方法,其特征在于,所述控制器为现场可编程逻辑器件,所述驱动电路为H桥电路。4.一种控制器,其特征在于,所述音圈电机与驱动电路电连接,并与位移传感器机械连接,所述驱动电路和所述位移传感器均与控制器电连接,所述控制器包括:第一运动控制单元,用于若接收到上电启动指令,则输出两路第一预设占空比的脉宽调制信号控制所述驱动电路输出第一预设电流信号,以驱动所述音圈电机以第一速度向第一方向运动;零点检测单元,用于检测所述位移传感器输出的零点信号是否为高电平,所述零点信号用于表征所述音圈电机是否到达零点位置;第二运动控制单元,用于若所述零点信号为高电平信号,则输出两路第二预设占空比的脉宽调制信号控制所述驱动电路输出第二预设电流信号,以控制所述音圈电机以第二速度向第二方向运动;第一计数单元,用于从预设初始数值开始对所述位移传感器输出的脉冲个数进行计数,并检测所述脉冲个数是否到达预设个数;第三运动控制单元,用于若所述脉冲个数到达预设个数,则控制所述驱动电路改变所述第二预设电流信号的方向,并检测所述音圈电机是否沿所述第一方向运动;第二计数单元,用于若所述音圈电机沿所述第一方向运动,则对所述位移传感器输出的脉冲个数进行逆计数,将...
【专利技术属性】
技术研发人员:李建伟,潘奕,彭世昌,丁庆,
申请(专利权)人:深圳市太赫兹系统设备有限公司,深圳市太赫兹科技创新研究院,
类型:发明
国别省市:广东;44
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。