16
传感器与微系统(Transducer and Microsyslem Technologies)2021年第40卷第6期 DOI ： 10.13873/J. 1000-9787(2021)06-0016-04
*收稿日期：2020-02-17
*基金项目：国家自然科学基金重点资助项目(51637001)；安徽大学青年骨干教师基金资助项目(J01005126)
吴涛-过希文3'，王京S3，李建-宫能伟I
(1•安徽大学电气工程与自动化学院，安徽合肥230601:
2.高节能电机及控制技术国家地方联合工程实验室，安徽合肥230601:
3•教育部电能质量研究中心，安徽合肥230601)
摘要：针对永磁球形电机转子体姿态检测技术精度不高，实时性较差等问题，提出了一种基于光学传感
器的永磁球形电机转子体实时姿态检测方法。使用安装在定子外壳上的3只光学传感器实时检测转子体
表面的速度。由微控制器将速度信息传递给上位机，并通过积分运算获得转子体的实时角度信息。在此
基础上，通过坐标变换和转子体上任意点的初始姿态信息求解出该点的实时姿态。实验结果表明：所提出
方法能够实吋、准确地检测转子体的姿态信息，为下一步实现永磁球形电机高精度的跟踪控制提供参考和
借鉴。
关键词：永磁球形电机；光学传感器；姿态检测
颅内高压
中图分类号：TM351； TP212 文献标识码：A 文章编号：1000-9787(2021)06-0016-04
Real-time attitude detection method of permanent magnet
spherical motor based on optical sensor *
WU Tao 1 , GUO Xiwen 112'3, WANG Qunjing 1-2'3, LI Jian 1, GONG Nengwei 1
(1. School of Electrical Engineering and Automation , Anhui University , Hefei 230601, China ；
2. National Engineering Laboratory of Energy-Saving Motor and Control Technology ,Hefei 230601,China ；
3. Power Quality Engineering Research Center of Ministry of Education , Hefei 230601, China )Abstract : Aiming at the problems of low precision and poor real-time of rotor attitude detection technology of
permanent magnet spherical motor ( PMSM ) ,a real-time attitude detection method of PMSM rotor based on optical
sensor is proposed. Three optical sensors installed on the stator shell are used to detect speed information of rotor
surface in real-time ・ Speed infomiation is transmitted to the upper computer by the microcontroller , and the time angle information of the rotor is obtained by integral operation . On this basis , the real-time allilude information of any point on the rotor is obtained by coordinate transformation and initial attitude informat i o n . The experimental
results show that the design method can detect the altitude information of the rotor in real-time and accurately ,
which provides reference for the next step to achieve high-precision tracking control of PMSM.
Keywords : PMSM ； optical sensor ； attitude detection
0引言
随着现代工业技术的不断发展，多自由度运动装置在
工业生产、航空航天等高精度领域得到了较为广泛的应用。
长期以来，为了完成复杂的多自由度运动，这种装置均是由
多个传统的单自由度电机与传统的机械传动机构结合构 成，这种结构通常使得整个系统过于庞大，驱动效率低且控
制精度差，限制了工业生产的发展。
在上述背景下，国内外专家学者门研究设计了多种能 够实现空间多维运动的多自由度电机。其中，永磁球形电
机一经提出，便受到了国内外学者的广泛关注。永磁球形
电机具有结构简单、体积小且控制效率高等特点。这使其 在机器人关节、三维空间运动和航空航天等领域有着广阔
的应用前景"叩。
由于永磁球形电机结构的特殊性，其控制系统远比传
tmac5
统电机更加复杂。而其转子体的姿态检测技术是实现永磁
球形电机闭环控制系统的关键要素之一。目前应用在永磁
球形电机上的姿态检测技术主要包括机器视觉姿态检测
方法［4'7\霍尔元件姿态检测方法3”〕和基于微机电系
第6期吴涛，等：基于光学传感器的永磁球形电机实吋姿态检测方法17
统（micro-electro-mechanical system,MEMS）传感器的姿态检测方法U⑵。一方面，机器视觉检测装置过于庞大、结构冗余，不便于实际应用。霍尔元件测量方法易受外界磁场干扰，检测性能保障度不高。MEMS传感器存在零点漂移问题，还需要在输出轴上安置传感器，不利于在工业应用中推广。另一方面，上述的检测方法目前大都停留在离线检测阶段，无法应用到实际控制中。
针对上述问题，本文提出了一种基于光学传感器的实吋姿态检测方法。在本文研究的姿态检测方法中，通过3只光学传感器对永磁球形电机转子体的运动信息进行解析，进而得到转子体表面的实时运动速度信息，然后通过STM32F4系列微控制器将传感器接收的运动信息传输给上位机进行解算，最终获得转子体的实时姿态信息。
1永磁球形电动机的基本结构
文献［13］详细介绍了本文研究的永磁球型电机基本结构。该电机主要由定子、球形转子和固定在转子上的输出轴组成。球形电机的定子外壳由2个半球形结构组成，转子固定在两个半球形定子外壳之
间。转子的输出轴穿过上方半球形定子外壳上的孔到达球形电机的外部。两个半球形定子外壳上分别均匀对称放置12个定子线圈，转子体中嵌有4层共40个圆柱形永磁体。因电机自身结构影响，转子输出轴受到一定限制，姿态角只可在一定范围内变化，其中X轴旋转角a与丫轴旋转角0的范围均为一37.5°~ 37.5°,Z轴的旋转角y不受影响，仍为0°-360%样机本体和仿真模型如图1所示。
图1永磁球形电机样机与仿真模型
2光学传感器姿态检测原理
lg mp32.1光学传感器简介
光学传感器主要由激光源、光学透镜组件、光学感应器、控制芯片四部分组成。本文选用ADNS-9800型光学传感器，其最大检测速度为150IPS，最大可检测加速度为30g“，帧数为12000EPS，分辨率为8200CP1，检测范围为1~5mm。检测原理是通过激光源发送红外脉冲信号射向球形电机转子体，当转子体运动时，由转子体反射回的脉冲信号会发生变化，控制芯片通过解算脉冲信号变化确定转子体的运动方向和运动速度［14J5］o
2.2光学传感器固定结构
如图2所示，通过3D打印技术制作一个固定支架将3只光学传感器SI,S2和S3呈120。间隔固定放置在
定子球壳上。传感器S1在定子静态坐标系XOY平面上的投影与X轴重合。光学传感器光学透镜组件的外表面与球形转子体的外表面相切，距离1mm左右。
图2传感器安放结构
2.3姿态检测原理
3只光学传感器分别固定放置在S1,S2和S3处，如图3所示，它们对应的球坐标分别为:SI（R,0,33。），S2（7?, 120°,33°）,S3（R,240。,33。），其中R为球形电机转子半径。件，匕，巴为传感器的位置向量s（，=l,2,3）为传感器检测到的转子体运动方向，相互垂直，且分别与所对应的传感器位置向量匕（i=l,2,3）垂直=1,2,3）为传感器检测到的转子体沿着捡，兀G=l,2,3）方向的运动速度。设P o为转子体上的任意一点，在转子体未运动时测出其初始姿态信息，当转子体运动时，光学传感器就会检测到转子体表面运动速度v xi,v yi（：=1,2,3）的变化，通过积分运算得到转子体的角度变化信息，再由坐标变换方程推算出转子体运动时P o点的实时姿态信息。
关系如下
%=（P,Xx i）•®
5=5xy.）-3
令
（i）（（Pl X%1）、（P1x7i）M=（P2X%2）（P2x r2）
（P3Xx3）
⑵\（.p3x r3）
/
18传感器与微系统第40卷
io=a)t(3)
&丿
则式(1)可简化为
v=M•O)(4)
所以®=M+其中M+是矩阵M的广义逆，计算公
式为
M+=(M'Af)~'M''(5)
根据式(3)、式(5)，可以得到以下关系
叫%(6)
V>2
@丿
%
1%丿
可以得到球形电机转子体运动时三个轴的角速度分量©,
◎.和5。通过对角速度分量进行积分，可以求出转子体三
个轴的角位移分量，即姿态角与y。积分公式如下
(7)
当转子体的姿态角已知时，通过三维坐标旋转变换公
式和转子体上任意一点P o的初始姿态信息可以得到该点
的实吋姿态信息。
设转子体上任意一点P o的初始姿态信息为S。，运动到
某…刻吋的姿态信息为Se，对应的球坐标分别为
S o=[x o r o z<,]T,Se=[Xe y B zj(8)
由式(9)即可计算出P.点随转子体运动时的实时姿态
信息
Se=c3•C2•G•s。(9)
式中C],C2，C3为旋转变换矩阵，其表达式如下
(\00
G=0cos a sin a
3-sin a cos a丿
(COS00—s叩
G=010
1sin/30cos0/
(cosy一s in y0) G=siny cosy0
<00b 上位机实时通信系统(10)
(11)
(12)
在本文研究的姿态检测方案中，选择了STM32F4微控制器作为主控芯片。当光学传感器获得球形电机转子体的运动方向和速度信息后传送给STM32F4微控制器，然后STM32F4微控制器通过串口通信将接收到的运动信息传送给上位机，由上位机对转子体进行实时姿态信息解算处理。
为保持本文设计方案中光学传感器与上位机之间的协调通信和传感器之间的同步通信，在光学传感器传输数据吋增加一个从0开始的标志位。当转子体运动吋，传感器每检测到一次运动信息数据就会在该数据后面加上标志位，并将标志位加1，当这些数据传输至上位机系统吋，由上位机根据标志位判断3只光学传感器所传输的数据是否为同一组运动信息，然后再进行姿态解算。
上位机通信界面如图4所示，当点击开始按钮时，上位机将实时接收转子体表面运动速度信息，然后对标志位进行判断。若标志位相同，通过式(6)得到角加速度，然后再通过式(7)得到实时角度信息，最后通过式(9)计算出P。点实时姿态信息并在波形显示器内绘制其实时运行三维轨迹图。若标志位不同，故障灯会闪烁，此时需点击重置按钮使上位机及传感器内所有数据归零，并以当前点作为巴的初始点重新计算其姿态信息。
图4上位机实时姿态解算系统控制界面
4实验
设置了3组具有代表性的实验，分别为中心点自旋运动实验、轴向倾斜运动实验和基于给定倾斜角旋转运动实验。在文献[11]中已经验证了MEMS传感器对本文所研究的球形电机转子体姿态检测的准确性，所以，为了便于分析实验结果，本文以MEMS传感器检测的P.点姿态信息作为正确姿态信息进行误差分析，同时为了符合实际应用，本文将检测点P。选在输出轴处。
4.1实验装置
图5为本文设计的永磁球形电机实时姿态检测方法的实验装置。它由永磁球形电机、光学传感器、STM32F4微控制器、上位机、MEMS传感器、驱动电路和电源组成。
4.2中心点自旋运动
在中心点自旋运动的对比实验中，a与0保持不变,y 由0。变化为360。。具体措施为保持转子体输出轴的位置坐标不变，使其与Z轴重合做自旋运动，输出轴的真实轨迹为球体最顶处的一个点，整个运动耗时约2s。
两种方案检
第6期吴涛，等：基于光学传感器的永磁球形电机实吋姿态检测方法19
图5姿态检测系统实验平台
测到的姿态轨迹如图6(a)所示。由图6(a)可见两种方案的检测结果基本都在输出轴初始位置的较小范围内，该图右上角箭头指向处为部分轨迹放大图。根据两种方案检测到的姿态信息，得到光学传感器
的相对误差，结果如图6(b)所示。X轴的误差约为一1.4~1.6mm,y轴的误差约为一0.9~l.lmm,Z轴的误差约为一0.9-1.1mm o
(a)检测轨迹(b)姿态检测误差
图6中心点自旋运动检测轨迹与姿态检测误差
4.3轴向倾斜运动
在轴向倾斜运动的对比实验中,a与0保持不变,7由0。变化为37.5%具体措施为将转子体的输岀轴沿垂直丫轴，朝着X轴正方向倾斜至与Z轴夹角为37.5。处，输出轴的实际轨迹为沿着球面的圆弧，其XOY平面方向的投影与X轴重合，整个运动耗时约2s。两种方案检测到的姿态轨迹如图7(a)所示。由图7(a)可见两种方案的检测结果基本重合，该图右上角箭头指向处为部分轨迹放大图。由放大部分可见检测误差差距较小。根据两种方案检测到的姿态信息，得到光学传感器的相对误差，结果如图7(b)所示。X轴的误差约为一1.6~1.7mm,y轴的误差约为-0.5-1.0mm,Z轴的误差约为一1.2~1.6mm o
时间/s
(a)检测轨迹(b)姿态检测误差
图7轴向倾斜运动的检测轨迹与姿态误差
4.4基于给定倾斜角旋转运动
在基于给定倾斜角旋转运动的对比实验中,y保持不变,a与0变化，具体措施为将转子体的输出轴倾斜至与z轴夹角为30。的位置处，然后围绕Z轴做旋转运动，使输出轴的实际轨迹为一个圆环，整个运动耗时约4s。两种方案检测到的姿态轨迹如图8(a)所示。由图8(a)可见两种方案的检测结果基本重合，该图右上角箭头指向处为部分轨迹放大图。由放大部分可见检测误差差距较小。以MEMS传感器的检测结果作为基准，根据两种方案检测到的姿态信息，得到光学传感器的相对误差，结果如图8(b)所示。X轴的误差约为一0.9~1.2mm,r轴的误差约为-1~0.9mm,Z轴的误差约为一1.2~1.7mm°
20
|-20
心-60
(a)检测轨迹
123
河南省干部调整叫停
时间/s
(b)姿态检测误差
图8基于给定倾斜角旋转运动的检测轨迹及姿态检测误差
5结论
本文提出了一种基于光学传感器的永磁球形电机转子体实时姿态检测方法，通过与MEMS传感器检测方法的检测结果进行对比，最大误差范围为一1.6~1.7mm，验证了该方案的可行性和准确性，为下一步实现永磁球形电机闭环控制提供了一定的研究基础。
参考文献：
[1]HUANG M S,HSU,Y L,FUNG R F.Minimum-energy point-to-
point trajectory planning for a motor-toggle servomechanism I J」.
IEEE/ASME Transactions on Mechatronics,2012,17(2)：337—343・[2]EZENEKWE D E,LEE K M.Design of air baring system for fine
motion spplication of mulli-DOF spherical actuator[C~\//Procee-dings of the IEEE/ASME International Conference on Advanced
Intelligent Mec：hatronics,Atlanta,GA,USA,IEEE,1999：812—818. [3J LEE K M, SON II S.Open-loop controller design and dynamic chaiacteristics of a spherical wheel motor[J]・IEEE Transactions on Industrial Electronics,2010,57(10)：3475—3482.
[4]LU Y,HU C G,WANG Q J,et al.A new rotor position measure
ment method for permanent magnet spherical motors[J].Applied Sciences-Basel,2018,8(12)：1-21.
[5]GARNER H,KLEMENT M,LEE,K M,Design and analysis of an
absolute non-contact orientation sensor for wrist motion control[C]//Proceeding of the IEEE/ASME International Conference on Advanced Intelligent Mechatronics,Como,Italy,IEEE,
2002：69-74.
[6]王京，钱詰，李争，等•基于机器视觉的永磁球形步进电机
转子位置检测方法[J].中国电机工程学报,2008,28(36)：
73-79.直流放大器
I7」U G L,LI J J,QIAN Z,et al.Studies on position detection of pemia-nent magnet spherical stepper motor based on bachine vision
Proceedings of the International Conference on Electrical Ma・
chines and Systems,Wuhan, China,IEEE,2009:1433—1436.
(下转第23
页)
第6期魏昕饪，等：用于代谢气体分析的化学改性微流控肺泡芯片23
化反应过程中以中间产物形式生成，一些按基化合物在给定的反应中具有特异性，例如脂质氧化会生成自由基。在本次实验中，通过将微流控芯片与化学捕获方法结合，本文进行了四种按基标志物气体在肺癌细胞代谢过程中的识别，结果表明肺癌细胞的生长代谢过程会生成较多的丙酮气体、甲醛和乙醛气体以及少量的2-丁酮气体。
4结论
介绍了一种用于细胞代谢气体捕获的微流控肺癌芯片，可进行细胞的片上培养和醛类代谢气体的识别。文中使用肺癌细胞(A549)进行实验，芯片可以较好地完成细胞培养和气体捕获的功能，证明了芯片功能的有效性，为细胞代谢气体的分析提供了一种有效的途径，为呼吸检测在肺癌疾病的应用提供了一定的理论依据。
参考文献：
[1]JEMAL A,SIEGEL R,XU J,et al.Cancer statistics[J].CA：A
Cancer Journal for Clinicians,2010,60：277—300.
[2]HORVATH I,LAZAR Z,GYULAI N,et al.Exhaled biomarkers
in lung cancer[J].European Respiratory Journal,2009,34:
261-275.
[3]ZHOU J,HUANG Z A,KUMAR U,et al.Review of recent
developments in determining volatile organic compounds in exhaled breath as biomarkers for lung c
ancer diagnosis[J].Analyti-ca Chimica Acta,2017,996：1—9.[4]秦建华，张敏，于浩，等.人体器官芯片[J].中国科学院院刊，
2017,32(12)：1281-1288.
[5]NALAYANDA D D,WANG Q,FULTON W B,et al.Engineering
an artificial alveolar-capillary membrane:A novel continuously
perfused model within microchannels[J].Journal of Pediatric
Surgery,2010,45(1)：45-51.
[6]张璐，吴振东，肖德涛，等.32S离子辐照PET薄膜制备亚微
米孔径核孔膜研究[J].原子核物理评论,2014,31(4)：528-
532.
[7]HENRY0Y F,VILLENAVE R,CRONCE M J,et al.Organs-on-
chips with integrated electrodes for trans-epithelial electrical
resistance(TEER)measurements of human epithelial barrier
function[J].Lab on a Chip,2017,17(13)：2264-2271.
[8]LI M X,BISWAS S,NANTZ M H,et al.Preconcentration and
analysis of trace volatile carbonyl compounds[J].Analytical
Chemistry,2012,84(3)：1288-1293.
[9]KNIPP R J,LI M X,FU X A,et al.A versatile probe for chemos-
elective capture and analysis of carbonyl compounds in exhaled
breath[J].Analytical Methods,2015,7(14)：6027-6033. [10]SELMI M,GAZZAH M H,BELMABROUK H.Optimization of
microfluidic biosensor efficiency by means of fluid flow enginee-
ring[J].Scientific Reports,2017,7(1)：5721—5732.
[11]RIAH1Y,COHEN G,SHAMNI0,et al.Signaling and cytotoxic
functions of4-hydroxyalkenalsf J]・American Journal of Physiolo
gy-Endocrinology and Metabolism,2010,299:E879—E886.
作者简介：
魏昕铉(1995-)，女，硕士，研究方向为生物芯片。
李明號(1986—)，男，通讯作者，博士，副研究员，主要研究领域为生物传感器及气体检测。
(上接第19页)
[8]WANG W,WANG J,JEWELL G W,et al.Design and control of
a novel spherical peimanent magnet actuator with three degree of
freedom[J].IEEE/ASME Transactions on Magnetics,2003, 8(4)：457-468・
[9]SON H, LEE K M,Two-DOF magnetic orientation sensor using
distributed multipole models for spherical wheel motor[J J.
Mechatronics,2011,21(1)：156-165.
[10]LI H F,LIU W J, LI B.A sensing system of the halbach array
permanent magnet spherical motor based on3-D Hall sensor[J].
Journal of Electrical Engineering&Technology,2018,13(1)：352-361.
[11]RONG Y P,WANG Q J,LU S L,el al.Improving altitude detec
tion performance for spherical motors using a MEMS inertial measurement sensor[J].IET Electric Power Applications,2019,
13(2)：198-205.
[12]陆寅，洪一，胡存刚，等.基于MEMS的永磁球形电机转子位
置检测方法研究[J]•电机与控制学报,2019,23(8)：87-95.
[13]QIAN Z,WANG Q J,JU,L F,et al.Torque modeling and control
algorithm of a permanent magnetic spherical motor[C]//Procee・dings of2009International Conference on Electrical Machines and Systems,Tokyo,Japan,IEEE,2010：944—949.
[14]LEE K M,ZHOU D.A real-time optical sensor for simultaneous
measurement of3-DOF motion[J]・IEEE/ASME Transactions on Mechatronics,2004,9(3)：499一507・
[15]XIN J G,XIA C L,LI H F,et al.A novel orientation measurement
using optical sensor for spherical motor[J|.Science China (Technological Sciences),2013,56(6)：1330—1339.
作者简介：
吴涛(1996-)，男，硕士，研究方向为球形电机控制。
党内法规清理的处理方式包括
过希文(1983-)，男，通讯作者，博士，副教授，主要研究领域为电机及其控制，电力电子与电力传动
。
豫公网安备41160202000603
站长QQ:729038198
关于我们
投诉建议