发明内容
本发明的目的是提出一种低成本高精度微小卫星反作用飞轮及其控制实现方法,以解决现有技术中存在的问题。
一种低成本高精度微小卫星反作用飞轮,包括9个线性霍尔传感器、3个轮体和控制板,每3个线性霍尔传感器彼此互为空间120°对称地安装在1个轮体的定子上,3个轮体分别设置于卫星的X、Y、Z轴上,3个轮体均双向信号连接控制板。
进一步的,控制板包括核心处理器DSP、3组集成驱动器、3个电流传感器和3组线性霍尔信号调理电路,核心处理器DSP至少集成有3组独立ADC、9路PWM输出口和18个GPIO信号接口,每个轮体分别对应1组集成驱动器、1个电流传感器和1组独立ADC,且3个轮体的对应关系独立,其中,
每组集成驱动器,用于执行电压控制命令,从而实现对与其对应的飞轮的速度和电流的实时控制;当每组集成驱动器异常时,每组集成驱动器通过GPIO信号接口向控制板反馈状态异常信息;
每个电流传感器,用于串联在其所对应的集成驱动器和轮体间的主回路中,从而获得采样电流模拟信号,采样电流模拟信号经运放放大后输出给对应的1组ADC;
每组线性霍尔信号调理电路,用于接收其所对应的轮体上的3个线性霍尔传感器发出的三组线性霍尔模拟信号,将三组线性霍尔模拟信号进行滤波射随处理后获得转速测量信息模拟信号,并发送至对应的1组独立ADC中;
每组独立ADC,用于采集3路线性霍尔模拟信号和电流模拟信号,进而解算出转速测量信息数字信号和采样电流数字信号;
核心处理器DSP,用于将转速测量信息与中心机下达的指令信息做差后转化为转矩电流指令,将转矩电流指令与采样电流做差后转化为电压控制命令,并将电压控制命令通过对应的PWM输出口输出至与PWM输出口对应的一组集成驱动器中。
进一步的,每组ADC中与对应的线性霍尔信号调理电路和电流传感器连接的通道均为非相邻通道。
一种低成本高精度微小卫星反作用飞轮的控制实现方法,基于上述的一种低成本高精度微小卫星反作用飞轮,方法包括以下步骤:
步骤一、核心处理器DSP上的每组独立ADC将对应的三路线性霍尔模拟信号转换为三路线性霍尔数字信号后,首先将三路线性霍尔数字信号转换成0~3.3V的电压信号,对该信号进行归一化,转化为-1~1之间的三路线性霍尔感测电压值;
步骤二、针对线性霍尔感测电压值的实测波形及步骤一中的解算结果,提出针对不同转速段两种速度解算方法。
进一步的,在步骤二中,具体的,针对不同转速段两种速度解算方法为:
在低转速段,将360°电气角分为12个区间,设在区间1为轮体的绝对位置0~30°,区间2为轮体的绝对位置30~60°,以此类推,区间12为轮体的绝对位置330~360°,依据三路线性霍尔感测电压值的正负确定轮体转子当前所在区间,并由三组感测电压值中符号相同的两组霍尔感测电压值的绝对值大小进行比较,选择绝对值小的一组霍尔感测电压值即斜率变化大的霍尔曲线进行反正弦运算,利用θ=θ
x+(n-1)*30°得到转子位置的电气角,通过计算转子角度增量对角速度采样时间的微分
得到转子的角速度;
在高转速段,通过解算相邻两路线性霍尔传感器归一化后感测电压过零的时间差,累计一个周期时间差总和T,利用360/T并经过单位转换得到转速信号。
进一步的,三路线性霍尔感测电压值按照开关霍尔的方式,高于霍尔输出电压信号中值,认为霍尔状态为“1”,低于霍尔输出电压信号中值,认为霍尔状态为“0”,共对应出6个霍尔状态,根据霍尔状态的变换实现轮体换相。
本发明的有以下优点:
1.本发明采用单片处理器同时实现三组飞轮的实时控制,用集成驱动器代替分立元件实现三相逆变器控制,精简控制线路结构,本专利提出一拖三硬件架构使研制成本、功耗和重量降低至少三分之一以上。
2.提出低转速段将360°电气角根据感测电压值的正负及绝对值大小分为12个区间,不同区间采用斜率最大的曲线进行反正弦运算,斜率最大的曲线段对应的角度变化大,进而保证速度解算精度,同时减少常规查表法对存储和计算资源需求。
3.提出高转速段采用软件记录任意一组线性霍尔过零的时间,解算相邻两次霍尔过零时间差,累计一个周期时间差总和T,应用360°/T解算速度的方式,解决线性霍尔高转速段速度精度差的问题。
具体实施方式
下面将结合本发明实施例中的附图对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
参照图1所示,一种低成本高精度微小卫星反作用飞轮,包括9个线性霍尔传感器、3个轮体和控制板,每3个线性霍尔传感器彼此互为空间120°对称地安装在1个轮体的定子上,3个轮体分别设置于卫星的X、Y、Z轴上,3个轮体均双向信号连接控制板。
具体的,每3个线性霍尔传感器空间120°对称安装在1个轮体的定子上,三个轮体分别放在卫星的X、Y、Z轴上,为对应轴向提供实时的输出力矩,采用一拖三的硬件架构,即3个轮体均连接在同一个控制板上,由一个控制器同时实现三组飞轮的实时控制,大幅度降低成本和功耗。
进一步的,控制板包括核心处理器DSP、3组集成驱动器、3个电流传感器和3组线性霍尔信号调理电路,核心处理器DSP至少集成有3组独立ADC、9路PWM输出口和18个GPIO信号接口,每个轮体分别对应1组集成驱动器、1个电流传感器和1组独立ADC,且3个轮体的对应关系独立,其中,
每组集成驱动器,用于执行电压控制命令,从而实现对与其对应的飞轮的速度和电流的实时控制;当每组集成驱动器异常时,每组集成驱动器通过GPIO信号接口向控制板反馈状态异常信息;
每个电流传感器,用于串联在其所对应的集成驱动器和轮体间的主回路中,从而获得采样电流模拟信号,采样电流模拟信号经运放放大后输出给对应的1组ADC;
每组线性霍尔信号调理电路,用于接收其所对应的轮体上的3个线性霍尔传感器发出的三组线性霍尔模拟信号,将三组线性霍尔模拟信号进行滤波射随处理后获得转速测量信息模拟信号,并发送至对应的1组独立ADC中;
每组独立ADC,用于采集3路线性霍尔模拟信号和电流模拟信号,进而解算出转速测量信息数字信号和采样电流数字信号;
核心处理器DSP,用于将转速测量信息与中心机下达的指令信息做差后转化为转矩电流指令,将转矩电流指令与采样电流做差后转化为电压控制命令,并将电压控制命令通过对应的PWM输出口输出至与PWM输出口对应的一组集成驱动器中。
具体的,9个线性霍尔传感器输出经由滤波和射随调理后,给核心处理器DSP上9路AD进行模数转换,实现轮体位置检测信号反馈输入;三个轮体相电流信号通过各自电流传感器采样,经由运放后输入到ADC进行电流采样,实现飞轮相电流信号反馈输入。为避免AD通道间串扰,选用具有3组独立ADC的DSP芯片,每个飞轮的三个线性霍尔信号及相电流信号接到一组独立ADC上,并避免选用相邻通道进行霍尔及相电流采样。将转速测量信息与中心机通过通信接口发送的指令信息做差后转化为转矩电流指令,转矩电流指令与采样电流做差后转化为电压控制命令,通过PWM信号控制轮体的集成驱动器,实现飞轮速度和电流实时控制。
进一步的,每组ADC中与对应的线性霍尔信号调理电路和电流传感器连接的通道均为非相邻通道。
一种低成本高精度微小卫星反作用飞轮控制实现方法,基于上述的一种低成本高精度微小卫星反作用飞轮,方法包括以下步骤:
步骤一、控制板上的每组ADC将对应的三路线性霍尔模拟信号转换为三路线性霍尔数字信号后,首先将三路线性霍尔数字信号转换成0~3.3V的电压信号,对该信号进行归一化,转化为-1~1之间的三路线性霍尔感测电压值;
步骤二、针对线性霍尔感测电压值的实测波形及解算结果,提出针对不同转速段两种速度解算方法:
在低转速段将360°电气角分为12个区间,设在区间1为轮体的绝对位置0~30°,区间2为轮体的绝对位置30~60°,以此类推,区间12为轮体的绝对位置330~360°,依据三路线性霍尔感测电压值的正负确定轮体转子当前所在区间,并由三组感测电压值中符号相同的两组霍尔感测电压值的绝对值大小进行比较,选择绝对值小的一组霍尔感测电压值即斜率变化大的霍尔曲线进行反正弦运算,利用θ=θ
x+(n-1)*30°得到转子位置的电气角,通过计算转子角度增量对角速度采样时间的微分
得到转子的角速度。
在高转速段,霍尔传感器的安装误差及幅值的微小变化都会影响高转速段的速度精度,本发明通过解算相邻两路线性霍尔传感器归一化后感测电压过零的时间差,累计一个周期时间差总和T,利用360/T并经过单位转换得到转速信号,该方法解决了线性霍尔高转速段精度差的问题。
进一步的,三路线性霍尔感测电压值按照开关霍尔的方式,高于霍尔输出电压信号中值,认为霍尔状态为“1”,低于霍尔输出电压信号中值,认为霍尔状态为“0”,共对应出6个霍尔状态,根据霍尔状态的变换实现轮体换相。
本发明提出针对高低转速不同的速度解算方法,控制算法简单,解算速度快,可实现反作用飞轮全转速段高精度的实时控制。实测结果表明,目前0转速段精度可达0.3rpm,全转速段精度可控制在1rpm以内,而且飞轮转速控制系统的相应时间、稳定时间、超调量稳态误差等指标均可以达到较好的控制效果。
以下将结合图1-图7对本发明低成本高精度微小卫星反作用飞轮实现装置及方法作进一步的详细描述。
图1所示为本发明设计的低成本高精度微小卫星反作用飞轮硬件实现框图,具体包括核心处理器DSP、3组集成驱动器(集成驱动1、集成驱动2、集成驱动3)、3个电流传感器(电流传感器1、电流传感器2、电流传感器3)、三组线性霍尔信号调理电路(线性霍尔信号调理电路1、线性霍尔信号调理电路2、线性霍尔信号调理电路3)和3个轮体(轮体x、轮体y、轮体z),每个轮体的定子上以空间120°对称安装三个线性霍尔传感器。以轮体x为例具体工作流程如下:
轮体x的三组线性霍尔输出模拟信号FL1_HallA、FL1_HallB、FL1_HallC经过霍尔信号调理电路1进行滤波射随后,输出给DSP的ADCA的三个非相邻通道(ADCA2、ADCA4、ADCA6)进行霍尔信号的采集,实现轮体位置检测信号反馈输入;在主回路串联电流传感器进行电流采样,经由运放放大后输入给ADCA的采集通道(ADCA0)进行电流采集,实现轮体相电流信号反馈输入。将转速测量信息与中心机通过通信接口发送的指令信息做差后转化为转矩电流指令,转矩电流指令与采样电流做差后转化为电压控制命令,通过PWM信号控制轮体x的集成驱动器1,实现飞轮速度和电流实时控制。
为避免AD通道间串扰,选用具有3组独立ADC的DSP芯片,轮体x的三个线性霍尔信号及相电流信号接到一组独立ADCA上,轮体y的三个线性霍尔信号及相电流信号接到一组独立ADCB上,轮体z的三个线性霍尔信号及相电流信号接到一组独立ADCC上,并避免选用相邻通道进行霍尔及相电流采样。
选用的DSP不限制具体型号,但片上需集成三组以上独立的ADC模块,同时至少具有9路PWM输出和18路以上的GPIO信号,便于实现三组飞轮独立及实时控制。采用单片处理器同时实现三组飞轮的实时控制,用集成驱动模块代替分立元件实现三相逆变器控制,精简控制线路结构,本发明提出一拖三的硬件架构使研制成本、功耗和重量降低至少三分之一以上。
图2是本发明提出的基于线性霍尔传感器在低转速段反作用飞轮速度解算方式,DSP片上ADCA将线性霍尔模拟信号FL1_HallA、FL1_HallB、FL1_HallC转换为数字信号FL1_HallA_D、FL1_HallB_D、FL1_HallC_D后,首先将数字信号转换成0~3.3V的电压信号,为了便于反正弦速度解算,对该信号进行归一化,转化为-1~1之间的线性霍尔感测电压值FL1_HallA_S、FL1_HallB_S、FL1_HallC_S;将360°电气角分为12个区间,设在区间1为轮体的绝对位置0~30°,区间2为轮体的绝对位置30~60°,以此类推,区间12为轮体的绝对位置330~360°,依据三个感测电压值的正负确定转子所在的区间,确定区间后,依据三组感测电压值中符号相同的两组霍尔感测电压值的绝对值大小进行比较,选择绝对值小的那组霍尔进行反正弦运算,利用θ=θ
x+(n-1)*30°得到转子位置的电气角,通过计算转子角度增量对角速度采样时间的微分得到转子的角速度。以区间1和区间2为例进行说明,如图2所示,FL1_HallA_S<0、FL1_HallB_S<0、FL1_HallC_S>0对应区间1和区间2,FL1_HallA_S、FL1_HallB_S符号相同,因此在两个区间中用FL1_HallA_S、FL1_HallB_S的绝对值进行比较,在区间1中,|FL1_HallA_S|<|FL1_HallB_S|,因此选用FL1_HallA_S曲线绝对值进行反正弦运算,得到此时转子位置的电气角θ=arcsin(|FL_HALLA_S|),在区间2中,|FL1_HallA_S|>|FL1_HallB_S|,因此选用FL1_HallB_S曲线的绝对值进行反正弦运算,得到此时转子位置的电气角θ=arcsin(|FL_HALLB_S|)+30°,通过计算转子角度增量对角速度采样时间的微分
得到转子的转速信号。不同区间采用斜率最大的曲线进行反正弦运算,斜率最大的曲线段对应的角度变化大,进而保证速度解算精度,同时减少常规查表法对存储和计算资源需求。
图3是本发明提出的基于线性霍尔传感器在高转速段反作用飞轮速度解算方式,归一化后三组线性霍尔感测电压值FL1_HallA_S、FL1_HallB_S、FL1_HallC_S;软件记录任意霍尔过零的时间,解算相邻两次霍尔过零时间差,累计一个周期时间差总和T,即记录FL1_HallA_S过零的时间t1,FL1_HallB_S过零的时间t2,FL1_HallC_S过零的时间t3,FL1_HallA_S第二次过零的时间t4,FL1_HallB_S第二次过零的时间t5,FL1_HallC_S第二次过零的时间t6,FL1_HallA_S第三次次过零的时间t7,则T1=t2-t1;T2=t3-t2;T3=t4-t3;T4=t5-t4;T5=t6-t5;T6=t7-t6;则累计时间和T=T1+T2+T3+T4+T5+T6,该时间段内飞轮转动一圈360°,则飞轮的转速为360°/T。该方法可以避免线性霍尔的安装误差及幅值的微小变化对高转速段速度精度的影响,从根本上解决了线性霍尔高转速精度差的问题。
图4、图5、图6、图7分别给出设定转速为0rpm、600rpm、1500rpm、5000rpm下飞轮的实际转速数据,从图中可以看出在中心机给定速度命令后,飞轮的转速精度在1rpm以内,满足星上速度模式使用要求。图5、图6给出600rpm和1500rpm下转速变化5rpm的实测数据曲线,从图中可以看出,飞轮的转速控制系统的相应时间、稳定时间、超调量稳态误差等指标均可以达到较好的控制效果。
以上实施示例只是用于帮助理解本发明的方法及其核心思想,对于本领域的一般技术人员,依据本发明的思想,在具体实施方式及应用范围上还可以做出若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。