CN105553341A - 基于can总线的升降设备多直流电机同步控制器及方法 - Google Patents
基于can总线的升降设备多直流电机同步控制器及方法 Download PDFInfo
- Publication number
- CN105553341A CN105553341A CN201410604977.4A CN201410604977A CN105553341A CN 105553341 A CN105553341 A CN 105553341A CN 201410604977 A CN201410604977 A CN 201410604977A CN 105553341 A CN105553341 A CN 105553341A
- Authority
- CN
- China
- Prior art keywords
- module
- motor
- control
- driving
- direct current
- 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.)
- Pending
Links
Landscapes
- Control Of Multiple Motors (AREA)
Abstract
本发明公开了一种基于CAN总线的升降设备多直流电机同步控制器及方法,包括外接在控制器外部的用于显示和操作的按钮与数码显示模块、用于接收用户指令和操作,反馈给主控模块电机控制与驱动第一模块,实现多个模块的扩展及同步控制的CAN总线,所述主控模块电机控制与驱动第一模块通过CAN总线向主控模块电机控制与驱动第二模块发送运行命令信号且协调各运动控制模块运动,所述主控模块电机控制与驱动第一模块与所述主控模块电机控制与驱动第二模块分别控制两组直流电机具有开放化的特点,由于系统采用了模块设计,各个模块都是基于CAN总线通讯的,其在CAN总线下易于扩展,且易于网络化操作。
Description
技术领域
本发明涉及直流电机同步控制装置,尤其是涉及一种基于CAN总线的升降设备多直流电机同步控制器。
背景技术
现代公司办公,长时间的静坐,会影响员工健康,给员工带来肥胖、颈椎病、腰椎病甚至脑血栓和癌症等疾病,由谷歌为首的美国硅谷多家知名公司纷纷为工作人员提供桌面可自由调节高度的升降桌,员工想站就站,想坐就坐,大大提高了工作效率。
传统的桌面升降技术,有以下几种方式:
1,基于可调的机械固定装置。这种调节方式,优点是价格便宜,缺点是由于使用的是机械的锁紧装置,操作不方便,需要人工手动调整桌面的升降,桌面的平衡性也得不到保证。
2,单电机的升降机构。这种调节方式,采用的是单动力调节方式,优点是升降平稳、可控,缺点是只能用于小桌面的升降,不能用于大桌面多支撑结构的桌面的调节,有使用局限性。
3,双电机的升降控制系统。这种调节方式,优点是可以同时控制桌面的两只支撑,实现整体桌面的升降,缺点是控制系统是由单片机控制,控制算法和运算速度低,运行平稳性差,同时只能适用于稍大一点的桌面,且只能有2个支撑点的桌面,不具备组网通讯功能。
考虑到,在电机控制桌面的升降过程中,由于桌面负载的变化和机械润滑度的影响,电机的运行速度可能会跟随负载的变化而变化,导致桌面的不平稳。
本系统在学习和继承传统的桌面升降技术的基础上,利用ARM处理器和CAN总线通讯技术,设计基于CAN总线的升降设备的多直流电机同步控制系统,能够利用CAN总线实时通讯,同时控制升降桌的2只或4只以上升降柱同步上升或下降,能够自动识别升降桌的顶部或底部,能够同步保持各升降柱的位置一致性,从而保证桌面在频繁升降过程中永远保持水平状态。
中国专利CN2014670466U《一种主从结构的多直流电机同步控制器》公开了包括主电机及若干从电机,所述主电机及各从电机上都同轴的安装有霍尔传感器,所述主电机与霍尔传感器组成的电源主回路上连接有主电子控制电路,所述各从电机及与其相连的霍尔传感器形成的电源支路上都连接有从电子控制电路,所述各霍尔传感器输出的脉冲信号输入到与之对应的电子控制电路,所述各霍尔传感器输出的脉冲信号输入到与之对应的电子控制电路,由电子控制电路按照主从结构控制该若干直流电机同步工作。但是其缺陷是:1、该同步控制器只能控制3台,不能扩展,不利于后期的扩展。2、其次在算法上,它单电机的闭环只是说用了算法器,而且只是用了一个反馈比例器,其成本比较高、使用不方便。
发明内容
本发明的目的是解决上述提出的问题,提供一种弥补传统的桌面升降技术,操作繁琐,桌面升降范围小,升降平稳性差的缺点,本发明提供一种基于ARM的32位处理器和具备CAN总线组网功能的,且采用模糊控制方式的一种基于CAN总线的升降设备多直流电机同步控制器。
本发明的目的是以如下方式实现的:一种基于CAN总线的升降设备多直流电机同步控制器,包括外接在控制器外部的用于显示和操作的按钮与数码显示模块、用于接收用户指令和操作,反馈给主控模块电机控制与驱动第一模块,实现多个模块的扩展及同步控制的CAN总线,所述主控模块电机控制与驱动第一模块通过CAN总线向主控模块电机控制与驱动第二模块发送运行命令信号且协调各运动控制模块运动,所述按钮与数码显示模块与主控模块电机控制与驱动第一模块双向电连接,所述主控模块电机控制与驱动第一模块与所述主控模块电机控制与驱动第二模块的两端连接在CAN总线上形成两条支路,所述主控模块电机控制与驱动第一模块与所述主控模块电机控制与驱动第二模块分别控制两组直流电机。
更进一步的优化方案是,上述的一种基于CAN总线的升降设备多直流电机同步控制器,所述主控模块电机控制与驱动第一模块的电机控制部分包括与CAN总线连接的总线连接的CAN接口、电源模块、ISP下载、CPU处理器、H桥驱动、AB相滤波,所述总线连接的CAN接口的输出端连接CPU处理器,所述CPU处理器发出PWM电机控制信号分别控制H桥驱动、AB相滤波,所述H桥驱动的输出端连接第一电机,所述第一电机的第一编码器的输出端与所述AB相滤波连接。
更进一步的优化方案是,上述的一种基于CAN总线的升降设备多直流电机同步控制器,所述主控模块电机控制与驱动第一模块上还包括第二H桥驱动与第二AB相滤波,所述第二H桥驱动通过第二电机的第二编码器与所述第二AB相滤波连接。
更进一步的优化方案是,上述的一种基于CAN总线的升降设备多直流电机同步控制器,所述主控模块电机控制与驱动第一模块与所述主控模块电机控制与驱动第二模块结构相同,所述主控模块电机控制与驱动第二模块控制第三电机与第三编码器电联,所述主控模块电机控制与驱动第二模块输出端控制第四电机与第四编码器电联。
更进一步的优化方案是,上述主控模块电机控制与驱动第一模块采用ARM7架构的处理器STM32F103R8T6,其主频72M;
所述处理器STM32F103R8T6与CAN通讯芯片TJA1050双向电连,实现CAN总线实时通讯功能;
所述处理器STM32F103R8T6与RS232通讯芯片SP3232EEN双向电连,实现RS232串口通讯和ISP下载程序功能;
所述处理器STM32F103R8T6与按键及数码管显示电路双向电连,用于用户命令的接收,并可显示当前同步位置,按键长按,可以设置正负软限位参数;
所述处理器STM32F103R8T6的输出端与PWM调速的输入端相连,所述PWM调速通过驱动电路与PHB29N08芯片H桥驱动相连,PHB29N08芯片H桥驱动与第一电机相连,实现第一电机的运动控制;
所述处理器STM32F103R8T6的输出端与第二PWM调速相连,所述第二PWM调速通过第二驱动电路与第二PHB29N08芯片H桥驱动相连,所述PHB29N08芯片H桥驱动与第二电机相连,实现第二电机的运动控制;
所述处理器STM32F103R8T6的AD模块与驱动回路电流检测相连,实现电流监控。
更进一步的优化方案是,上述的一种基于CAN总线的升降设备多直流电机同步控制器,所述第一编码器与AB相滤波电路相连,所述AB相滤波电路的输出端通过中断控制器的输入端与处理器STM32F103R8T6连接,实现第一电机的编码器反馈采集;所述第二电机的编码器与第二AB相滤波电路相连,所述第二AB相滤波电路的输出端通过中断控制器相连与所述处理器STM32F103R8T6相连,实现第二电机的编码器反馈采集。
更进一步的优化方案是,上述的一种基于CAN总线的升降设备多直流电机同步控制器,所述电源模块中通过220V交流输入,与150W环形变压器相连,获得18V的交流电,所述150W环形变压器与整流模块KBPC1010整流后获得24V的直流电,所述整流模块KBPC1010连接降压模块LM2576将24V直流降压成5V直流电,供外围电路使用;通过降压模块1117M33将5V直流电降压成3.3V直流电,供处理器STM32F103R8T6及相关模块使用。
更进一步的优化方案是,上述的一种基于CAN总线的升降设备多直流电机同步控制器,所述主控模块电机控制与驱动第一模块还包括驱动控制部分,所述驱动模块主要采用负责速度控制的PID控制器和负责位置的控制的模糊补偿器相结合的方式。
更进一步的优化方案是,上述任一项所述的一种基于CAN总线的升降设备多直流电机同步控制器的控制方法,所述驱动控制部分的控制方法包括以下步骤:
A、系统通过接收速度命令,然后发送命令给单个电机的控制回路,电机M1的反馈器,接收到命令后,通过PID控制器,控制PWM波输出,从而控制电机M1的运动控制,同时通过采集的电机编码器位置,获得电机M1的速度反馈1,将速度反馈1输入给电机M1的反馈器,从而实现电机M1的速度控制;
B、其次,电机Mn的第二反馈器,接收到命令后,通过第二PID控制器,控制PWM波输出,从而控制电机Mn的运动控制,同时通过采集的电机编码器位置,获得电机Mn的速度反馈n,将速度反馈n输入给电机Mn的第二反馈器,从而实现电机Mn的速度控制。
C、通过CAN总线,将各个电机的位置数据z1、z2、zn等发送给模糊补偿器,所述模糊补偿器通过将理论位置z与各个电机的位置数据z1、z2、zn比较,通过策略选择,将调节数据发回到各个电机的速度反馈器中,从而实现多直流电机的速度跟随和位置控制,实现了桌面随着负载变化而带来的调节滞后和停止后位置倾斜的问题。
更进一步的优化方案是,上述的一种基于CAN总线的升降设备多直流电机同步控制器的控制方法:
首先启动开关键,先进行上电初始化将处理器及外围电路初始化;
然后进行总线初始化建立CAN总线通讯,查询设备;
其次检查有无按键按下,如果有的话,看其是向上的还是向下的,如果向上,控制电机正向旋转,如果向下,控制电机负向旋转;
同时进行PID速度控制和同步运行控制,通过模糊决策比较理论位置值,算出模糊控制策略;
最后并时刻进行电流检查、软限位检查和CAN通讯,在最后要停止时,还有进行位置同步微调,消除积累误差,如果有错误时,进入异常处理,最后确保电机的运行安全。
本发明的优点:1、本发明具有开放化的特点,由于系统采用了模块设计,各个模块都是基于CAN总线通讯的,其在CAN总线下易于扩展,且易于网络化操作。
2、本发明具有智能化的特点,由于采用32位处理器芯片,同时采用模糊控制算法,提高了控制系统的运算速度,增强了系统的控制平稳性。
3、本发明具有集成化的特点,采用控制部分与驱动部分集成的设计,增强了系统的可维护性,组合方便,拆装简单。
附图说明
为了使本发明的内容更容易被清楚地理解,下面根据具体实施例并结合附图,对本发明作进一步详细的说明,其中
图1本发明的结构示意图;
图2本发明的控制结构示意图;
图3本发明的控制方法结构示意图;
图4本发明的程序运行流程图;
附图标记:1、按钮与数码显示模块,2、CAN总线,3、主控模块电机控制与驱动第一模块,4、主控模块电机控制与驱动第二模块,5、电源模块,6、CAN接口,7、ISP下载,8、CPU处理器,9、H桥驱动,10、AB相滤波,11、第二H桥驱动,12、第二AB相滤波,13、第一电机,14、第一编码器,15、第二电机,16、第二编码器,17、第三电机,18、第三编码器,19、第四电机,20、第四编码器,22、150W环形变压器,23、整流模块KBPC1010,24、降压模块LM2576,25、降压模块1117M33,26、CAN通讯芯片TJA1050,27、RS232通讯芯片SP3232EEN,28、处理器STM32F103R8T6,29、按键及数码管显示电路,30、PWM调速,31、中断控制器,32、第二PWM调速,33、驱动回路电流检测,34、驱动电路,35、第二驱动电路,36、PHB29N08芯片H桥驱动,38、第二AB相滤波电路,39、第二PHB29N08芯片H桥驱动,41、电机M1,42、PID控制器,44、反馈器,49、速度反馈n,50、第二PID控制器,51、电机Mn,552、第二反馈器,53、接收速度命令,4、模糊补偿器,55、理论位置z,60、上电初始化,61、总线初始化,62、有无按键,63、向上的还是向下,64、位置同步微调,65、电机正向旋转,66、电机负向旋转,67、PID速度控制,68、同步运行控制,69、模糊决策,70、电流检查,71、软限位检查,73、异常处理,74、CAN通讯。
具体实施方式:
见图1至图4所示,一种基于CAN总线的升降设备多直流电机同步控制器,包括外接在控制器外部的用于显示和操作的按钮与数码显示模块1、用于接收用户指令和操作,反馈给主控模块电机控制与驱动第一模块3,实现多个模块的扩展及同步控制的CAN总线2,所述主控模块电机控制与驱动第一模块3通过CAN总线2向主控模块电机控制与驱动第二模块4发送运行命令信号且协调各运动控制模块运动,所述按钮与数码显示模块1与主控模块电机控制与驱动第一模块3双向电连接,所述主控模块电机控制与驱动第一模块3与所述主控模块电机控制与驱动第二模块4的两端连接在CAN总线2上形成两条支路,所述主控模块电机控制与驱动第一模块3与所述主控模块电机控制与驱动第二模块4分别控制两组直流电机。
见图1所示,所述主控模块电机控制与驱动第一模块3的电机控制部分包括与CAN总线2连接的总线连接的CAN接口6、电源模块5、ISP下载7、CPU处理器8、H桥驱动9、AB相滤波10,所述总线连接的CAN接口6的输出端连接CPU处理器8,所述CPU处理器8发出PWM电机控制信号分别控制H桥驱动9、AB相滤波10,所述H桥驱动9的输出端连接第一电机13,所述第一电机13的第一编码器14的输出端与所述AB相滤波10连接。所述主控模块电机控制与驱动第一模块3上还包括第二H桥驱动11与第二AB相滤波12,所述第二H桥驱动11通过第二电机15的第二编码器16与所述第二AB相滤波12连接。所述主控模块电机控制与驱动第一模块3与所述主控模块电机控制与驱动第二模块4结构相同,所述主控模块电机控制与驱动第二模块4控制第三电机17与第三编码器18电联,所述主控模块电机控制与驱动第二模块4输出端控制第四电机19与第四编码器20电联。
见图2所示,所述主控模块电机控制与驱动第一模块3采用ARM7架构的处理器STM32F103R8T628,其主频72M;
所述处理器STM32F103R8T628与CAN通讯芯片TJA105026双向电连,实现CAN总线实时通讯功能;
所述处理器STM32F103R8T628与RS232通讯芯片SP3232EEN27双向电连,实现RS232串口通讯和ISP下载程序功能;
所述处理器STM32F103R8T628与按键及数码管显示电路29双向电连,用于用户命令的接收,并可显示当前同步位置,按键长按,可以设置正负软限位参数;
所述处理器STM32F103R8T628的输出端与PWM调速30的输入端相连,所述PWM调速30通过驱动电路34与PHB29N08芯片H桥驱动36相连,PHB29N08芯片H桥驱动36与第一电机13相连,实现第一电机13的运动控制;
所述处理器STM32F103R8T628的输出端与第二PWM调速32相连,所述第二PWM调速32通过第二驱动电路35与第二PHB29N08芯片H桥驱动39相连,所述PHB29N08芯片H桥驱动39与第二电机15相连,实现第二电机15的运动控制;
所述处理器STM32F103R8T628的AD模块与驱动回路电流检测33相连,实现电流监控。
见图1至图2所示,所述第一编码器14与AB相滤波电路37相连,所述AB相滤波电路37的输出端通过中断控制器31的输入端与处理器STM32F103R8T628连接,实现第一电机13的编码器反馈采集;所述第二电机的编码器16与第二AB相滤波电路38相连,所述第二AB相滤波电路38的输出端通过中断控制器31相连与所述处理器STM32F103R8T628相连,实现第二电机2的编码器反馈采集。所述电源模块5中通过220V交流输入,与150W环形变压器22相连,获得18V的交流电,所述150W环形变压器22与整流模块KBPC101023整流后获得24V的直流电,所述整流模块KBPC101023连接降压模块LM257624将24V直流降压成5V直流电,供外围电路使用;通过降压模块1117M3325将5V直流电降压成3.3V直流电,供处理器STM32F103R8T628及相关模块使用。所述主控模块电机控制与驱动第一模块3还包括驱动控制部分,所述驱动模块3主要采用负责速度控制的PID控制器42和负责位置的控制的模糊补偿器54相结合的方式。
见图3至图4所示,所述驱动控制部分的控制方法包括以下步骤:
A、系统通过接收速度命令53,然后发送命令给单个电机的控制回路,电机M1的反馈器44,接收到命令后,通过PID控制器42,控制PWM波输出,从而控制电机M143的运动控制,同时通过采集的电机编码器位置,获得电机M143的速度反馈141,将速度反馈141输入给电机M1的反馈器44,从而实现电机M1的速度控制;
B、其次,电机Mn的第二反馈器52,接收到命令后,通过第二PID控制器50,控制PWM波输出,从而控制电机Mn51的运动控制,同时通过采集的电机编码器位置,获得电机Mn51的速度反馈n49,将速度反馈n49输入给电机Mn的第二反馈器52,从而实现电机Mn的速度控制。
C、通过CAN总线2,将各个电机的位置数据z1、z2、zn等发送给模糊补偿器54,所述模糊补偿器54通过将理论位置z55与各个电机的位置数据z1、z2、zn比较,通过策略选择,将调节数据发回到各个电机的速度反馈器中,从而实现多直流电机的速度跟随和位置控制,实现了桌面随着负载变化而带来的调节滞后和停止后位置倾斜的问题。
一种基于CAN总线的升降设备多直流电机同步控制器的控制方法:
首先启动开关键,先进行上电初始化60将处理器及外围电路初始化;
然后进行总线初始化61建立CAN总线通讯,查询设备;
其次检查有无按键62按下,如果有的话,看其是向上的还是向下的63,如果向上,控制电机正向旋转65,如果向下,控制电机负向旋转66;
同时进行PID速度控制67和同步运行控制68,通过模糊决策69比较理论位置值,算出模糊控制策略;
最后并时刻进行电流检查70、软限位检查71和CAN通讯74,在最后要停止时,还有进行位置同步微调64,消除积累误差,如果有错误时,进入异常处理73,最后确保电机的运行安全。
以上所述的具体实施例,对本发明的目的、技术方案和有益效果进行了进一步详细说明,所应理解的是,以上所述仅为本发明的具体实施例而已,并不用于限制本发明,凡在本发明的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (10)
1.一种基于CAN总线的升降设备多直流电机同步控制器,包括外接在控制器外部的用于显示和操作的按钮与数码显示模块(1)、用于接收用户指令和操作,反馈给主控模块电机控制与驱动第一模块(3),实现多个模块的扩展及同步控制的CAN总线(2),所述主控模块电机控制与驱动第一模块(3)通过CAN总线(2)向主控模块电机控制与驱动第二模块(4)发送运行命令信号且协调各运动控制模块运动,所述按钮与数码显示模块(1)与主控模块电机控制与驱动第一模块(3)双向电连接,所述主控模块电机控制与驱动第一模块(3)与所述主控模块电机控制与驱动第二模块(4)的两端连接在CAN总线(2)上形成两条支路,所述主控模块电机控制与驱动第一模块(3)与所述主控模块电机控制与驱动第二模块(4)分别控制两组直流电机。
2.根据权利要求1所述的基于CAN总线的升降设备多直流电机同步控制器,其特征在于:所述主控模块电机控制与驱动第一模块(3)的电机控制部分包括与CAN总线(2)连接的总线连接的CAN接口(6)、电源模块(5)、ISP下载(7)、CPU处理器(8)、H桥驱动(9)、AB相滤波(10),所述总线连接的CAN接口(6)的输出端连接CPU处理器(8),所述CPU处理器(8)发出PWM电机控制信号分别控制H桥驱动(9)、AB相滤波(10),所述H桥驱动(9)的输出端连接第一电机(13),所述第一电机(13)的第一编码器(14)的输出端与所述AB相滤波(10)连接。
3.根据权利要求1所述的基于CAN总线的升降设备多直流电机同步控制器,其特征在于:所述主控模块电机控制与驱动第一模块(3)上还包括第二H桥驱动(11)与第二AB相滤波(12),所述第二H桥驱动(11)通过第二电机(15)的第二编码器(16)与所述第二AB相滤波(12)连接。
4.根据权利要求1所述的基于CAN总线的升降设备多直流电机同步控制器,其特征在于:所述主控模块电机控制与驱动第一模块(3)与所述主控模块电机控制与驱动第二模块(4)结构相同,所述主控模块电机控制与驱动第二模块(4)控制第三电机(17)与第三编码器(18)电联,所述主控模块电机控制与驱动第二模块(4)输出端控制第四电机(19)与第四编码器(20)电联。
5.根据权利要求1所述的基于CAN总线的升降设备多直流电机同步控制器,其特征在于:所述主控模块电机控制与驱动第一模块(3)采用ARM7架构的处理器STM32F103R8T6(28),其主频72M;
所述处理器STM32F103R8T6(28)与CAN通讯芯片TJA1050(26)双向电连,实现CAN总线实时通讯功能;
所述处理器STM32F103R8T6(28)与RS232通讯芯片SP3232EEN(27)双向电连,实现RS232串口通讯和ISP下载程序功能;
所述处理器STM32F103R8T6(28)与按键及数码管显示电路(29)双向电连,用于用户命令的接收,并可显示当前同步位置,按键长按,可以设置正负软限位参数;
所述处理器STM32F103R8T6(28)的输出端与PWM调速(30)的输入端相连,所述PWM调速(30)通过驱动电路(34)与PHB29N08芯片H桥驱动(36)相连,PHB29N08芯片H桥驱动(36)与第一电机(13)相连,实现第一电机(13)的运动控制;
所述处理器STM32F103R8T6(28)的输出端与第二PWM调速(32)相连,所述第二PWM调速(32)通过第二驱动电路(35)与第二PHB29N08芯片H桥驱动(39)相连,所述PHB29N08芯片H桥驱动(39)与第二电机(15)相连,实现第二电机(15)的运动控制;
所述处理器STM32F103R8T6(28)的AD模块与驱动回路电流检测(33)相连,实现电流监控。
6.根据权利要求1所述的基于CAN总线的升降设备多直流电机同步控制器,其特征在于:所述第一编码器(14)与AB相滤波电路(37)相连,所述AB相滤波电路(37)的输出端通过中断控制器(31)的输入端与处理器STM32F103R8T6(28)连接,实现第一电机(13)的编码器反馈采集;所述第二电机的编码器(16)与第二AB相滤波电路(38)相连,所述第二AB相滤波电路(38)的输出端通过中断控制器(31)相连与所述处理器STM32F103R8T6(28)相连,实现第二电机2的编码器反馈采集。
7.根据权利要求2所述的基于CAN总线的升降设备多直流电机同步控制器,其特征在于:所述电源模块(5)中通过220V交流输入,与150W环形变压器(22)相连,获得18V的交流电,所述150W环形变压器(22)与整流模块KBPC1010(23)整流后获得24V的直流电,所述整流模块KBPC1010(23)连接降压模块LM2576(24)将24V直流降压成5V直流电,供外围电路使用;通过降压模块1117M33(25)将5V直流电降压成3.3V直流电,供处理器STM32F103R8T6(28)及相关模块使用。
8.根据权利要求1所述的基于CAN总线的升降设备多直流电机同步控制器,其特征在于:所述主控模块电机控制与驱动第一模块(3)还包括驱动控制部分,所述驱动模块(3)主要采用负责速度控制的PID控制器(42)和负责位置的控制的模糊补偿器(54)相结合的方式。
9.根据权利要求上述任一项所述的一种基于CAN总线的升降设备多直流电机同步控制器的控制方法,其特征在于:所述驱动控制部分的控制方法包括以下步骤:
A、系统通过接收速度命令(53),然后发送命令给单个电机的控制回路,电机M1的反馈器(44),接收到命令后,通过PID控制器(42),控制PWM波输出,从而控制电机M1(43)的运动控制,同时通过采集的电机编码器位置,获得电机M1(43)的速度反馈1(41),将速度反馈1(41)输入给电机M1的反馈器(44),从而实现电机M1的速度控制;
B、其次,电机Mn的第二反馈器(52),接收到命令后,通过第二PID控制器(50),控制PWM波输出,从而控制电机Mn(51)的运动控制,同时通过采集的电机编码器位置,获得电机Mn(51)的速度反馈n(49),将速度反馈n(49)输入给电机Mn的第二反馈器(52),从而实现电机Mn的速度控制。
C、通过CAN总线(2),将各个电机的位置数据z1、z2、zn等发送给模糊补偿器(54),所述模糊补偿器(54)通过将理论位置z(55)与各个电机的位置数据z1、z2、zn比较,通过策略选择,将调节数据发回到各个电机的速度反馈器中,从而实现多直流电机的速度跟随和位置控制,实现了桌面随着负载变化而带来的调节滞后和停止后位置倾斜的问题。
10.根据权利要求9所述的一种基于CAN总线的升降设备多直流电机同步控制器的控制方法,其特征在于:
首先启动开关键,先进行上电初始化(60)将处理器及外围电路初始化;
然后进行总线初始化(61)建立CAN总线通讯,查询设备;
其次检查有无按键(62)按下,如果有的话,看其是向上的还是向下的(63),如果向上,控制电机正向旋转(65),如果向下,控制电机负向旋转(66);
同时进行PID速度控制(67)和同步运行控制(68),通过模糊决策(69)比较理论位置值,算出模糊控制策略;
最后并时刻进行电流检查(70)、软限位检查(71)和CAN通讯(74),在最后要停止时,还有进行位置同步微调(64),消除积累误差,如果有错误时,进入异常处理(73),最后确保电机的运行安全。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410604977.4A CN105553341A (zh) | 2014-10-30 | 2014-10-30 | 基于can总线的升降设备多直流电机同步控制器及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410604977.4A CN105553341A (zh) | 2014-10-30 | 2014-10-30 | 基于can总线的升降设备多直流电机同步控制器及方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN105553341A true CN105553341A (zh) | 2016-05-04 |
Family
ID=55832324
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410604977.4A Pending CN105553341A (zh) | 2014-10-30 | 2014-10-30 | 基于can总线的升降设备多直流电机同步控制器及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105553341A (zh) |
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106308036A (zh) * | 2016-11-04 | 2017-01-11 | 上海锐士智能家居有限公司 | 一种升降桌电路控制系统 |
CN106371379A (zh) * | 2016-12-07 | 2017-02-01 | 上海电气集团股份有限公司 | 一种机器人的运动控制模块 |
CN107814162A (zh) * | 2017-09-28 | 2018-03-20 | 贵州梵净山生态农业股份有限公司 | 一种肉类加工生产线通用平移装置控制系统 |
CN108021042A (zh) * | 2016-11-03 | 2018-05-11 | 上海优爱宝智能机器人科技股份有限公司 | 展示物动态悬吊装置大规模阵列的控制装置 |
CN108919732A (zh) * | 2018-10-18 | 2018-11-30 | 大鹏高科(武汉)智能装备有限公司 | 一种应用于机器人执行驱动的控制箱 |
CN109065986A (zh) * | 2018-08-27 | 2018-12-21 | 苏州索贝斯新能源科技有限公司 | 一种电池温度控制电路 |
CN109343436A (zh) * | 2018-11-26 | 2019-02-15 | 杭州为诺智能科技有限公司 | 2路双电机可独立工作的控制器及其使用方法 |
CN109687774A (zh) * | 2018-12-28 | 2019-04-26 | 厦门厦华科技有限公司 | 一种可自由升降的电容桌及其控制方法 |
CN110971150A (zh) * | 2019-11-12 | 2020-04-07 | 杭州电子科技大学 | 一种基于wifi通信的多台电机同步控制系统 |
CN111824960A (zh) * | 2019-04-19 | 2020-10-27 | 深圳市雷赛智能控制股份有限公司 | 龙门同步控制方法、控制设备及电机控制系统 |
EP3633850A4 (en) * | 2017-05-25 | 2021-02-24 | DewertOkin Technology Group Co., Ltd. | DESKTOP IMPACT PROTECTION CONTROL DEVICE WITH ELECTRIC HEIGHT ADJUSTMENT |
CN112596465A (zh) * | 2020-11-27 | 2021-04-02 | 中物智建(武汉)科技有限公司 | 一种多轴同步控制方法及控制系统 |
CN113170972A (zh) * | 2021-03-26 | 2021-07-27 | 浙江乐歌智能驱动科技有限公司 | 一种基于总线结构的多立柱升降系统及识别控制方法 |
CN114488916A (zh) * | 2022-04-14 | 2022-05-13 | 常州市凯迪电器股份有限公司 | 基于集成桌推与can总线通讯的电动升降桌控制方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5321343A (en) * | 1993-02-16 | 1994-06-14 | Aeg Automation Systems Corporation | Digital motor control system |
CN203849590U (zh) * | 2014-03-11 | 2014-09-24 | 中国矿业大学 | 多轴运动数控系统 |
-
2014
- 2014-10-30 CN CN201410604977.4A patent/CN105553341A/zh active Pending
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5321343A (en) * | 1993-02-16 | 1994-06-14 | Aeg Automation Systems Corporation | Digital motor control system |
CN203849590U (zh) * | 2014-03-11 | 2014-09-24 | 中国矿业大学 | 多轴运动数控系统 |
Non-Patent Citations (1)
Title |
---|
罗高卿: "电动升降桌多电机同步控制系统涉及", 《机电一体化》 * |
Cited By (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108021042A (zh) * | 2016-11-03 | 2018-05-11 | 上海优爱宝智能机器人科技股份有限公司 | 展示物动态悬吊装置大规模阵列的控制装置 |
CN108021042B (zh) * | 2016-11-03 | 2024-01-19 | 上海优爱宝智能机器人科技股份有限公司 | 展示物动态悬吊装置大规模阵列的控制装置 |
CN106308036A (zh) * | 2016-11-04 | 2017-01-11 | 上海锐士智能家居有限公司 | 一种升降桌电路控制系统 |
CN106371379A (zh) * | 2016-12-07 | 2017-02-01 | 上海电气集团股份有限公司 | 一种机器人的运动控制模块 |
US11271514B2 (en) | 2017-05-25 | 2022-03-08 | Dewertokin Technology Group Co., Ltd | Impact protection controller for electric height-adjustable desk |
EP3633850A4 (en) * | 2017-05-25 | 2021-02-24 | DewertOkin Technology Group Co., Ltd. | DESKTOP IMPACT PROTECTION CONTROL DEVICE WITH ELECTRIC HEIGHT ADJUSTMENT |
CN107814162A (zh) * | 2017-09-28 | 2018-03-20 | 贵州梵净山生态农业股份有限公司 | 一种肉类加工生产线通用平移装置控制系统 |
CN109065986A (zh) * | 2018-08-27 | 2018-12-21 | 苏州索贝斯新能源科技有限公司 | 一种电池温度控制电路 |
CN108919732A (zh) * | 2018-10-18 | 2018-11-30 | 大鹏高科(武汉)智能装备有限公司 | 一种应用于机器人执行驱动的控制箱 |
CN109343436A (zh) * | 2018-11-26 | 2019-02-15 | 杭州为诺智能科技有限公司 | 2路双电机可独立工作的控制器及其使用方法 |
CN109687774A (zh) * | 2018-12-28 | 2019-04-26 | 厦门厦华科技有限公司 | 一种可自由升降的电容桌及其控制方法 |
CN111824960A (zh) * | 2019-04-19 | 2020-10-27 | 深圳市雷赛智能控制股份有限公司 | 龙门同步控制方法、控制设备及电机控制系统 |
CN110971150A (zh) * | 2019-11-12 | 2020-04-07 | 杭州电子科技大学 | 一种基于wifi通信的多台电机同步控制系统 |
CN112596465A (zh) * | 2020-11-27 | 2021-04-02 | 中物智建(武汉)科技有限公司 | 一种多轴同步控制方法及控制系统 |
CN113170972A (zh) * | 2021-03-26 | 2021-07-27 | 浙江乐歌智能驱动科技有限公司 | 一种基于总线结构的多立柱升降系统及识别控制方法 |
CN114488916A (zh) * | 2022-04-14 | 2022-05-13 | 常州市凯迪电器股份有限公司 | 基于集成桌推与can总线通讯的电动升降桌控制方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105553341A (zh) | 基于can总线的升降设备多直流电机同步控制器及方法 | |
CN203434899U (zh) | 一种用于多电机的高精度伺服控制器 | |
CN106287603B (zh) | 一种照明灯高效调节装置 | |
CN207375543U (zh) | 一种自平衡电梯轿厢 | |
CN102142800A (zh) | 舞台同步升降控制系统和方法 | |
CN105022182A (zh) | 调光玻璃控制器、调光玻璃控制系统以及控制方法 | |
CN105490594A (zh) | 双无刷低压直流电机驱动控制系统及方法 | |
CN108037776A (zh) | 一种电动升降桌同步升降控制系统 | |
CN102361425B (zh) | 直流无刷变频空调控制电路 | |
CN205327012U (zh) | 一种自动调节速度的雨刮器控制系统 | |
CN206996358U (zh) | 一种用于led生产的配胶装置 | |
CN202696530U (zh) | 数字化直流电流调节器 | |
CN106208730B (zh) | 一种可控整流器的变频器 | |
CN206348619U (zh) | 一种带EtherCAT总线的直流驱动型伺服电机 | |
CN205151129U (zh) | 升降式输送机 | |
CN211712577U (zh) | 一种高度可调的轧盖机 | |
CN205389182U (zh) | 一种基于单片机控制的直流电机调速系统 | |
CN202334328U (zh) | 一种交流恒流源 | |
CN203204403U (zh) | 基于can总线起底板控制系统 | |
CN203891733U (zh) | 一种基于无线单片机的室内亮度调控装置 | |
CN209776994U (zh) | 一种数控贴标设备 | |
CN105523452A (zh) | 一种多曳引机同步控制系统及其工作方法 | |
CN207916338U (zh) | 一种y轴龙门同步的打印机机架 | |
CN208445826U (zh) | 一种用于电动工具的集成调速线路板 | |
CN207251508U (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 | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20160504 |
|
WD01 | Invention patent application deemed withdrawn after publication |