CN102097973A - 一种基于嵌入式芯片的超声电机驱动控制器 - Google Patents

一种基于嵌入式芯片的超声电机驱动控制器 Download PDF

Info

Publication number
CN102097973A
CN102097973A CN2011100379141A CN201110037914A CN102097973A CN 102097973 A CN102097973 A CN 102097973A CN 2011100379141 A CN2011100379141 A CN 2011100379141A CN 201110037914 A CN201110037914 A CN 201110037914A CN 102097973 A CN102097973 A CN 102097973A
Authority
CN
China
Prior art keywords
output
pulse
logic device
embedded
signal
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN2011100379141A
Other languages
English (en)
Other versions
CN102097973B (zh
Inventor
时运来
朱华
梁大志
孙志俊
赵淳生
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
JIANGSU FENGKE UTRASONIC MOTORS TECHNOLOGY Co Ltd
Original Assignee
Nanjing University of Aeronautics and Astronautics
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Nanjing University of Aeronautics and Astronautics filed Critical Nanjing University of Aeronautics and Astronautics
Priority to CN 201110037914 priority Critical patent/CN102097973B/zh
Publication of CN102097973A publication Critical patent/CN102097973A/zh
Application granted granted Critical
Publication of CN102097973B publication Critical patent/CN102097973B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • General Electrical Machinery Utilizing Piezoelectricity, Electrostriction Or Magnetostriction (AREA)

Abstract

本发明提供一种基于嵌入式芯片的超声电机驱动控制器,属于超声电机驱动控制器领域。本发明包括嵌入式可编程芯片PSoC(1)、第一驱动与匹配模块(2)和第二驱动与匹配模块(3);其中嵌入式可编程芯片PSoC(1)的输出端分别与所述两个驱动与匹配模块的输入端连接,所述两个驱动与匹配模块的输出端分别与超声电机(4)的输入端连接。本发明通过对超声电机驱动脉冲个数、脉冲组数、脉冲周期的精准控制,达到了对直线型超声电机纳米级直线位移和旋转型超声电机亚角秒级旋转角度分辨率的精准脉冲驱动控制的目标。

Description

一种基于嵌入式芯片的超声电机驱动控制器
技术领域
本发明涉及一种输出驱动脉冲信号精准控制的超声电机驱动控制器,通过嵌入式芯片硬件的合理配置和软件程序的动态控制,能够实现对输出驱动脉冲的精准控制,属于超声电机驱动控制器领域。
背景技术
超声电机是一种利用逆压电效应,弹性体振动和摩擦传动原理的新型电机。与传统电机相比,超声电机具有低转速、力矩/质量比大、响应速度快、停电自锁、纳米级分辨率、无电磁干扰等特点。
超声电机需要两路正交相位的超声频率信号源来驱动。目前,已有的超声电机驱动器通常提供的IO接口,供外部控制器(例如:运动控制卡等)来控制电机的启动/停止和用模拟电压来调节电机的转速。但是,无法实现纳米级分辨率要求的输出驱动脉冲串的起始相位和停止相位均为0o相位、以及输出脉冲数目可以实现精准控制的要求。
“基于嵌入式系统级芯片超声电机驱动控制器”(申请号:200710134453.3),利用PSoC芯片的PWM模块直接产生四路方波信号推动MOS管完成直流逆变,具有根据电机运行状态自动调频、调相和调压功能,但是却不能够实现输出驱动脉冲相位和脉冲数目的精准控制。
发明内容
本发明的所要解决的技术问题是提供一种基于嵌入式芯片的超声电机驱动控制器,通过PSoC芯片的可编程功能和脉冲数目控制算法,构造超声电机驱动器,能够实现输出驱动脉冲相位和脉冲数目的精准控制,从而实现直线型超声电机纳米级直线位移和旋转型超声电机亚角秒级旋转角度分辨率的精准脉冲驱动控制的目标。
本发明为实现上述发明目的采用如下技术方案:
一种基于嵌入式芯片的超声电机驱动控制器,包括嵌入式可编程芯片PSoC、第一驱动与匹配模块和第二驱动与匹配模块;其中嵌入式可编程芯片PSoC的输出端分别与所述两个驱动与匹配模块的输入端连接,所述两个驱动与匹配模块的输出端分别与超声电机的输入端连接。
进一步的,前述的基于嵌入式芯片的超声电机驱动控制器中,嵌入式可编程芯片PSoC包括计数器、定时器、串行通信模块、以及分别两路同步正交的第一PWM信号发生器与第二PWM信号发生器、第一缓冲器与第二缓冲器、第一输出总线逻辑器与第二输出总线逻辑器;
其中,所述第二PWM信号发生器的信号输出端分别与计数器的信号输入端、第二输出总线逻辑器连接;所述第一PWM信号发生器的信号输出端与所述第一输出总线逻辑器的信号输入端连接;
所述计数器的信号输出端分别与所述两个缓冲器的信号输入端连接,所述第一缓冲器的信号输出端与第一输出总线逻辑器的信号输入端连接,第二缓冲器的信号输出端与第二输出总线逻辑器的信号输入端连接;
所述第一输出总线逻辑器的信号输出端与第一驱动与匹配模块的信号输入端连接,第二输出总线逻辑器的信号输出端与第二驱动与匹配模块的信号输入端连接;     所述串行通信模块与远程控制端连接。
进一步的,前述的基于嵌入式芯片的超声电机驱动控制器中,计数器用于控制驱动脉冲的输出个数,该计数器的中断模块能用来控制脉冲组数以及脉冲周期。
进一步的,前述的基于嵌入式芯片的超声电机驱动控制器中,定时器产生0.5ms时间基准,用于嵌入式可编程芯片PSoC的分时调度系统的定时控制。
进一步的,前述的基于嵌入式芯片的超声电机驱动控制器中,串行通信模块用于实现对输出驱动频率、脉冲个数、脉冲组数、脉冲周期等动/静态参数的远程设置。
本发明采用上述技术方案具有如下有益效果:
本发明通过对超声电机驱动频率、脉冲个数、脉冲组数、脉冲周期的精准控制,达到了对直线型超声电机纳米级直线位移和旋转型超声电机亚角秒级旋转角度分辨率的精准脉冲驱动控制的目标。
 
附图说明:
图1 是基于PSoC芯片的超声电机驱动器;
图2 是PSoC可编程数字单元链接电原理框图;
图3 是PSoC分时调度系统原理框图;
图4 是PSoC脉冲模式输出示意图;
图5 是PSoC脉冲中断原理框图。
 
具体实施方案:
下面结合附图对技术方案的实施作进一步的详细描述:
如图1所示,超声电机驱动控制器由嵌入式可编程芯片PSoC,驱动与匹配模块PA-A和PA-B构成。嵌入式可编程芯片PSoC输出的两路信号A和/A接端接驱动与匹配模块PA-A的输入端,嵌入式可编程芯片PSoC输出的两路信号B和/B接端接驱动与匹配模块PA-B的输入端。驱动与匹配模块PA-A和PA-B的输出端接超声电机USM的输入端。
图2为 PSoC可编程数字单元链接电原理框图。在PSoC Designer 集成开发环境中创建本发明工程,构建工程的用户模块和端口配置,用户模块和端口属性的设置及初始化和用户模块与端口的链接等。本发明使用了两组PWM信号发生器5和8、两组缓冲器6和9、两组输出总线逻辑7和10、一组计数器11、一组定时器12、一组串行通信模块13等15个可编程数字单元和2个可编程输出总线,占用了5个(A、/A、B、/B、TXD)输出端口和1个(RXD)输入端口,系统使用了1个(0.5ms定时中断)中断、1个(Clk)48MHz的全局时钟、1个(Enable)信号同步信号。Enable同步信号能够保证两相输出频率信号的正交性。
PWM信号发生器5和PWM信号发生器8的输出频率信号,决定了超声电机的速度。
计数器11的输入时钟来自于PWM信号发生器8的输出信号,计数器11输出‘1’电平的脉冲宽度,通过输出总线逻辑7和10的‘逻辑与’,就决定了输出端口A, /A, B, /B 输出的脉冲个数。通过串行口可以动态改变计数器11 的‘1’电平的脉冲宽度,也就实现了对超声电机的输出驱动脉冲个数的有效控制。
输出总线逻辑7和10为可配置的输出逻辑,其中:‘0’电平输出逻辑,能够实现输出端口A、/A,B, /B的输出为‘0’电平;‘A’输出逻辑,使PWM发生器5和8与输出端口A、/A,B和/B直接连接,可实现PWM发生器5和8到输出端口A、/A,B和/B的直接输出,可实现‘连续模式’驱动信号输出;‘逻辑与’输出逻辑,可以实现计数器11输出的‘1’电平来控制PWM发生器的信号输出,可实现输出端口A、/A,B和/B的 ‘脉冲模式’驱动信号输出。
计数器中断模块实现对PWM发生器到输出端口A、/A,B和/B的脉冲信号输出的0°相位、脉冲组数、脉冲周期等精准控制。中断服务在第二次中断开始,令输出总线逻辑器输出为‘逻辑与’方式,由计数器的输出‘1’电平来控制输出总线逻辑器的‘逻辑与’,令PWM发生器到输出端口A、/A,B和/B脉冲信号的脉冲个数为给定值;脉冲判断如果脉冲组数值减一后等于零,关闭中断退出,并令输出总线逻辑器输出为‘0’电平输出逻辑,从而停止超声电机的运行。周期判断:判断如果脉冲个数发完,但脉冲周期值没有结束,令输出总线逻辑器处于‘0’电平输出逻辑,使输出端口A、/A,B和/B输出为‘0’电平,等待下一次中断。
图3为 PSoC分时调度系统原理框图。
系统初始化——完成对可编程数字单元API函数的参数配置、以及系统动态和静态参数的预置。
中断设置——开放0.5ms定时中断,启动分时调度系统的时间基准;开放串行通信模块13串行口中断,为RS232串行口接收数据作好准备;开放计数器11中断,可以实现PWM发生器5和8到输出端口A、/A,B, /B脉冲信号输出的0°相位、脉冲组数、脉冲周期等精准控制;开放全局中断,允许定时和串行通信模块13中断开始工作。
分时调度系统——按照0.5ms基准时间的节拍,不间断的通过RS232通讯口由UartRead()函数,将超声电机的工作频率、脉冲个数、脉冲组数、脉冲周期等动态和静态参数值,以及系统命令字下载到PSoC芯片,按0.5ms基准时间的倍数,在程序SetSpeed()、SetNumber()、SetGroup()、SetCycle()以及Run()等函数中顺序执行。系统分成脉冲和连续等两种运行模式。 
图5 为PSoC脉冲中断原理框图。计数器11中断程序实现对PWM发生器5和8到输出端口A、/A,B, /B脉冲信号输出的0°相位、脉冲组数、脉冲周期等精准控制。
中断服务——在第二次中断开始,令输出总线逻辑器7和10输出为‘逻辑与’方式,由计数器11的输出‘1’电平来控制输出总线逻辑器7和10的‘逻辑与’,令PWM发生器5和8到输出端口A、/A,B, /B脉冲信号的脉冲个数为给定值;
脉冲判断——如果脉冲组数值减一后等于零,关闭中断退出,并令输出总线逻辑器7和10输出为‘0’电平输出逻辑,从而停止超声电机的运行。
周期判断——判断如果脉冲个数发完,但脉冲周期值没有结束,令输出总线逻辑器7和10处于‘0’电平输出逻辑,使输出端口A、/A,B和/B输出为‘0’电平,等待下一次中断。
脉冲工作模式:Run()函数根据‘脉冲’系统命令字,输出端口A、/A,B, /B的相位均以0°相位开始和结束,使得超声电机上的两相每一个驱动脉冲都能够是一个完整的周期;
如图4所示,保证了所合成的行波有完整的周期性,实现了直线型超声电机纳米级直线位移和旋转型超声电机亚角秒级旋转角度分辨率,从而达到了精准控制的目的。驱动器所需的工作频率、脉冲个数、脉冲组数、脉冲周期等参数通过串行通信模块13下载。
连续工作模式:Run()函数根据‘连续’系统命令字,超声电机不间断地运行,一直到Run()函数收到‘停止’系统命令字为止。
最后说明的是:以上实施例子仅用于说明本发明而非限制,虽然对本发明进行了详细的说明,本领域的专业人员应当理解,对本发明的修改和等效置换,而不脱离本发明的精神和范围,其均应涵盖在本发明的权利要求范围之内。

Claims (5)

1.一种基于嵌入式芯片的超声电机驱动控制器,其特征在于:包括嵌入式可编程芯片PSoC(1)、第一驱动与匹配模块(2)和第二驱动与匹配模块(3);其中嵌入式可编程芯片PSoC(1)的输出端分别与所述两个驱动与匹配模块的输入端连接,所述两个驱动与匹配模块的输出端分别与超声电机(4)的输入端连接。
2.根据权利要求1所述的基于嵌入式芯片的超声电机驱动控制器,其特征在于:所述嵌入式可编程芯片PSoC(1)包括计数器(11)、定时器(12)、串行通信模块(13)、以及分别两路同步正交的第一PWM信号发生器(5)与第二PWM信号发生器(8)、第一缓冲器(6)与第二缓冲器(9)、第一输出总线逻辑器(7)与第二输出总线逻辑器(10); 其中,所述第二PWM信号发生器(8)的信号输出端分别与计数器(11)的信号输入端、第二输出总线逻辑器(10)连接;所述第一PWM信号发生器的信号输出端与所述第一输出总线逻辑器(7)的信号输入端连接;
所述计数器(11)的信号输出端分别与所述两个缓冲器的信号输入端连接,所述第一缓冲器(6)的信号输出端与第一输出总线逻辑器(7)的信号输入端连接,第二缓冲器(9)的信号输出端与第二输出总线逻辑器(10)的信号输入端连接; 所述第一输出总线逻辑器(7)的信号输出端与第一驱动与匹配模块(2)的信号输入端连接,第二输出总线逻辑器(10)的信号输出端与第二驱动与匹配模块(3)的信号输入端连接; 所述串行通信模块(13)与远程控制端连接。
3.根据权利要求2所述的基于嵌入式芯片的超声电机驱动控制器,其特征在于:所述计数器(11)用于控制驱动脉冲的输出个数,该计数器的中断模块能用来控制脉冲组数以及脉冲周期。
4.根据权利要求2所述的基于嵌入式芯片的超声电机驱动控制器,其特征在于:所述定时器(12)产生0.5ms时间基准,用于嵌入式可编程芯片PSoC(1)的分时调度系统的定时控制。
5.根据权利要求2所述的基于嵌入式芯片的超声电机驱动控制器,其特征在于:所述串行通信模块(13)用于实现对输出驱动频率、脉冲个数、脉冲组数、脉冲周期等动/静态参数的远程设置。
CN 201110037914 2011-02-15 2011-02-15 一种基于嵌入式芯片的超声电机驱动控制器 Expired - Fee Related CN102097973B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN 201110037914 CN102097973B (zh) 2011-02-15 2011-02-15 一种基于嵌入式芯片的超声电机驱动控制器

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN 201110037914 CN102097973B (zh) 2011-02-15 2011-02-15 一种基于嵌入式芯片的超声电机驱动控制器

Publications (2)

Publication Number Publication Date
CN102097973A true CN102097973A (zh) 2011-06-15
CN102097973B CN102097973B (zh) 2013-01-09

Family

ID=44130875

Family Applications (1)

Application Number Title Priority Date Filing Date
CN 201110037914 Expired - Fee Related CN102097973B (zh) 2011-02-15 2011-02-15 一种基于嵌入式芯片的超声电机驱动控制器

Country Status (1)

Country Link
CN (1) CN102097973B (zh)

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102590357A (zh) * 2012-01-09 2012-07-18 山东科技大学 基于PSoC3的煤岩声发射监测系统模拟信号源
CN103427707A (zh) * 2013-07-15 2013-12-04 南京航空航天大学 一种超声电机驱动器
CN103760813A (zh) * 2014-01-22 2014-04-30 哈尔滨工业大学 全自动贴片机在dos操作系统下的实时采样控制系统及方法
CN107623460A (zh) * 2017-09-21 2018-01-23 四川航天机电工程研究所 一种基于SoC的大力矩超声电机驱动系统
CN110398933A (zh) * 2018-04-25 2019-11-01 Ls产电株式会社 基于可编程逻辑控制器的位置控制装置
CN112054741A (zh) * 2020-08-06 2020-12-08 深圳市杉川机器人有限公司 电机控制方法、装置、终端设备及存储介质

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1275379A (zh) * 2000-04-12 2000-12-06 刘其军 一种烧、烫伤膏药及其制造方法
US6384513B1 (en) * 1998-01-29 2002-05-07 Seiko Instruments Inc. Ultrasonic motor and method of manufacturing the motor
CN1275379C (zh) * 2003-01-15 2006-09-13 东南大学 基于数字信号处理芯片的超声波电机线性驱动控制器
CN101060291A (zh) * 2007-05-25 2007-10-24 哈尔滨工业大学 无变压器的超声波电机驱动器
CN101150289B (zh) * 2007-10-23 2010-09-15 南京航空航天大学 基于嵌入式系统级芯片的超声电机驱动控制器
CN202364153U (zh) * 2011-02-15 2012-08-01 南京航空航天大学 一种基于嵌入式芯片的超声电机驱动控制器

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6384513B1 (en) * 1998-01-29 2002-05-07 Seiko Instruments Inc. Ultrasonic motor and method of manufacturing the motor
CN1275379A (zh) * 2000-04-12 2000-12-06 刘其军 一种烧、烫伤膏药及其制造方法
CN1275379C (zh) * 2003-01-15 2006-09-13 东南大学 基于数字信号处理芯片的超声波电机线性驱动控制器
CN101060291A (zh) * 2007-05-25 2007-10-24 哈尔滨工业大学 无变压器的超声波电机驱动器
CN101150289B (zh) * 2007-10-23 2010-09-15 南京航空航天大学 基于嵌入式系统级芯片的超声电机驱动控制器
CN202364153U (zh) * 2011-02-15 2012-08-01 南京航空航天大学 一种基于嵌入式芯片的超声电机驱动控制器

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102590357A (zh) * 2012-01-09 2012-07-18 山东科技大学 基于PSoC3的煤岩声发射监测系统模拟信号源
CN103427707A (zh) * 2013-07-15 2013-12-04 南京航空航天大学 一种超声电机驱动器
CN103760813A (zh) * 2014-01-22 2014-04-30 哈尔滨工业大学 全自动贴片机在dos操作系统下的实时采样控制系统及方法
CN103760813B (zh) * 2014-01-22 2016-05-25 哈尔滨工业大学 全自动贴片机在dos操作系统下的实时采样控制系统及方法
CN107623460A (zh) * 2017-09-21 2018-01-23 四川航天机电工程研究所 一种基于SoC的大力矩超声电机驱动系统
CN107623460B (zh) * 2017-09-21 2019-03-19 四川航天机电工程研究所 一种基于SoC的大力矩超声电机驱动系统
CN110398933A (zh) * 2018-04-25 2019-11-01 Ls产电株式会社 基于可编程逻辑控制器的位置控制装置
CN112054741A (zh) * 2020-08-06 2020-12-08 深圳市杉川机器人有限公司 电机控制方法、装置、终端设备及存储介质
CN112054741B (zh) * 2020-08-06 2022-06-03 深圳市杉川机器人有限公司 电机控制方法、装置、终端设备及存储介质

Also Published As

Publication number Publication date
CN102097973B (zh) 2013-01-09

Similar Documents

Publication Publication Date Title
CN102097973B (zh) 一种基于嵌入式芯片的超声电机驱动控制器
CN102111106B (zh) 一种基于arm和dsp的电机综合控制装置
CN203434899U (zh) 一种用于多电机的高精度伺服控制器
CN101917159A (zh) 一种直线电机运行速度及位移控制系统及其控制方法
CN102088266A (zh) 一种基于fpga数字化控制的无刷电机无级变速控制器
CN202364153U (zh) 一种基于嵌入式芯片的超声电机驱动控制器
CN103607149A (zh) 一种超声电机舵伺服系统及其控制方法
CN102470332B (zh) 使用线性泵的可变流量控制器
CN202034935U (zh) 步进电机的控制装置
CN105403190A (zh) 一种步进电机位移检测系统
CN102419565A (zh) 一种具有脉冲同步输出功能的plc
CN204993138U (zh) 一种防卡死电机控制系统
US20070248337A1 (en) Real-time responsive motor control system
CN205232084U (zh) 步进电机开环驱动器
CN106253758B (zh) 多电机同轴驱动控制系统
CN205051613U (zh) 一种步进电机控制电路
CN102195544B (zh) 电动机驱动装置
CN204836010U (zh) 一种步进电机控制系统
CN103401495A (zh) 利用单片机控制的步进电机系统及控制方法
Sun et al. An SoC-based platform for integrated multi-axis motion control and motor drive
CN202652137U (zh) 单片机控制步进电机调速装置
CN202174626U (zh) 应用于砖机的可调式振动盘伺服控制装置
CN202856676U (zh) 一种步进电机驱动器
CN106712653B (zh) 基于fpga的电机控制系统及方法
CN105281620A (zh) 一种步进电机控制电路

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
ASS Succession or assignment of patent right

Owner name: NANJING WANNA ULTRASONIC MOTOR CO., LTD.

Free format text: FORMER OWNER: NANJING UNIVERSITY OF AERONAUTICS AND ASTRONAUTICS

Effective date: 20130909

C41 Transfer of patent application or patent right or utility model
COR Change of bibliographic data

Free format text: CORRECT: ADDRESS; FROM: 210016 NANJING, JIANGSU PROVINCE TO: 210019 NANJING, JIANGSU PROVINCE

TR01 Transfer of patent right

Effective date of registration: 20130909

Address after: 210019 Xincheng Science Park, Jianye District, Jiangsu, Nanjing 5108

Patentee after: Nanjing Wanma Ultrasonic Motors Co.,Ltd.

Address before: Yudaojie Baixia District of Nanjing City, Jiangsu Province, No. 29 210016

Patentee before: Nanjing University of Aeronautics and Astronautics

ASS Succession or assignment of patent right

Owner name: JIANGSU FENGKE ULTRASONIC MOTORS TECHNOLOGY CO., L

Free format text: FORMER OWNER: NANJING WANNA ULTRASONIC MOTOR CO., LTD.

Effective date: 20141113

C41 Transfer of patent application or patent right or utility model
COR Change of bibliographic data

Free format text: CORRECT: ADDRESS; FROM: 210019 NANJING, JIANGSU PROVINCE TO: 211514 NANJING, JIANGSU PROVINCE

TR01 Transfer of patent right

Effective date of registration: 20141113

Address after: Liuhe District of Nanjing City, Jiangsu province 211514 Dong Gou Zhen Fu Qian Jie No. 1

Patentee after: Jiangsu Fengke Utrasonic Motors Technology Co., Ltd.

Address before: 210019 Xincheng Science Park, Jianye District, Jiangsu, Nanjing 5108

Patentee before: Nanjing Wanma Ultrasonic Motors Co.,Ltd.

CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20130109

Termination date: 20170215

CF01 Termination of patent right due to non-payment of annual fee