一种用于舵叶运动检测平台的四路步进电机控制装置
本发明提供一种用于舵叶运动检测平台的四路步进电机控制装置,属于自动化控制。
背景技术:
1、在舵叶旋转方向检测、舵面运动状态观察、小型机电控制实验和相关教学科研场景中,通常需要使舵叶或舵叶执行机构按照预设方向、角度、速度和动作顺序进行运动。舵叶运动是否可控、动作是否可重复、实际运动状态是否能够被反馈,会直接影响外部检测装置对舵叶旋转方向、角度变化或运动状态的判断结果。
2、一种常见现有方案是采用分立模块式搭建方式。该方式通常包括 mcu 开发板、多个外置步进电机或直流电机驱动模块、电源转换模块、串口屏或上位机通信模块、编码器模块、限位/回零传感器模块以及大量外部连接线。mcu 开发板通过若干 gpio 或定时器引脚向各个外置驱动模块输出控制信号,外置驱动模块再分别连接对应电机。在该方案中,外部电源经独立电源模块转换为不同电压后分别供应 mcu、驱动模块、传感器和显示模块。编码器、home、limit 等反馈信号通过独立线束接入 mcu 或转接板。串口屏或上位机用于输入运动参数、启动停止命令或显示运行状态。外部视觉检测装置则采集舵叶运动图像,并根据图像处理结果判断舵叶旋转方向或运动状态。该方案在早期验证阶段具有搭建灵活、替换模块方便的特点,但其整体结构依赖大量外部连接关系,不适合需要长期重复使用、四路执行机构同步或半同步控制、硬件反馈校验和后续样机化的舵叶运动检测平台。
3、另一类现有方案是采用通用多轴步进电机控制板。该类控制板通常面向三维打印机、雕刻机、数控设备或通用运动控制场景,能够输出多路步进电机的脉冲、方向和使能信号,并可具备一定的限位输入、通信接口或扩展接口。通用多轴步进电机控制板的设计重点通常是多轴插补、轨迹执行、通用轴控制和常规限位保护,其接口定义、反馈结构和控制流程往往针对通用机械运动场景,而不是针对舵叶运动检测平台中的四片舵叶动作验证、视觉检测结果对照和硬件反馈校验需求。
4、因此,需要一种专门面向舵叶运动检测平台的四路步进电机控制装置,将主控、电源管理、四路步进电机驱动、编码器反馈、限位/回零、人机交互、调试和保护功能统一组织起来,形成可控、可反馈、可扩展的硬件控制基础。
技术实现思路
1、本发明要解决的总体技术问题是:在舵叶运动检测平台中,如何形成一种统一的四路步进电机控制装置,使四路舵叶执行机构能够稳定、可重复地按照预设方向、角度、速度和动作流程运动,并将实际运动反馈数据输出给外部检测或调试设备,从而提高舵叶运动检测实验的可控性、可复现性和验证可靠性。
2、解决分立模块式搭建导致的接线复杂、接口分散、重复搭建困难和维护效率低的问题。
3、解决四路步进电机驱动、主控、电源、编码器、限位/回零和人机交互缺少统一装置结构的问题。
4、解决多路电机运行时供电、地线和信号连接关系混乱,可能影响反馈采集和通信稳定性的问题。
5、解决舵叶执行机构实际运动状态缺少统一采集通道的问题。
6、解决外部视觉检测结果缺少硬件侧控制指令和运动反馈数据进行对照校验的问题。
7、解决现有通用多轴控制板不能充分匹配舵叶运动检测平台专用接口和反馈校验需求的问题。
8、本发明面向的舵叶运动检测平台,可以通过外部视觉检测装置采集舵叶运动图像,并对舵叶旋转方向、角度变化或运动状态进行判断。本发明不限定外部视觉检测装置的图像采集硬件和视觉识别算法,而是提供与其配合的硬件控制和反馈基础。也就是说,本发明的核心在于:稳定、可重复地驱动四路舵叶执行机构,并提供硬件侧运动反馈数据,使外部视觉检测结果能够与实际运动状态进行对照。
9、对于四片舵叶或四路执行机构同时存在的检测平台,若每一路电机驱动、供电、反馈和显示接口均采用分立模块连接,会导致线束数量、接口数量和维护复杂度明显增加。尤其在需要反复实验、调整动作参数、进行回零校准和对比检测结果时,分立式搭建方式会降低系统复现性和调试效率。
10、本发明提供的完整技术方案:
11、一种用于舵叶运动检测平台的四路步进电机控制装置,所述控制装置包括主控模块、电源管理模块、四路步进电机驱动模块、编码器反馈模块、限位或回零模块、人机交互模块、调试模块以及保护模块。
12、所述控制装置设置于外部直流电源、四路步进电机、四路舵叶执行机构、反馈传感器、人机交互设备和外部视觉检测装置之间。外部直流电源向控制装置供电;控制装置通过四路步进电机驱动模块分别驱动四台步进电机;每台步进电机带动对应舵叶或舵叶执行机构运动;反馈传感器将信号送回控制装置;控制装置通过串口屏、上位机或调试接口输出运行状态和硬件反馈数据。
13、具体的:
14、主控模块用于对四路步进电机驱动模块、编码器反馈模块、限位或回零模块、人机交互模块和调试模块进行统一控制。主控模块向每一路步进电机驱动模块输出 step、dir、en、nsleep 或等效控制信号。其中 step 信号用于控制步进数量和运动速度,dir 信号用于控制旋转方向,en 信号用于控制驱动通道是否有效,nsleep 信号用于驱动模块休眠或唤醒控制。
15、主控模块接收每一路编码器 a 相、b 相和可选 z 相信号,并可接收 home、limit和 nfault 信号。主控模块根据编码器 a或b 相相位关系判断实际运动方向,根据编码器计数变化判断实际角度变化,根据 home 信号建立参考零位,根据 limit 信号判断运动边界,根据 nfault 信号判断驱动异常。
16、电源管理模块用于接收外部直流供电,并向步进电机驱动模块、主控模块、传感器接口、人机交互模块和调试模块提供所需电源。电源管理模块包括输入接口、过流保护、瞬态过压保护、输入滤波、降压转换和低压稳压结构。
17、四路步进电机驱动模块的每一路步进电机驱动模块对应一台二相四线步进电机,进而对应一片舵叶或一个舵叶执行机构。各路驱动模块独立运行,或者由 mcu 按照预设实验流程进行同步启动、顺序启动或协同控制。
18、每一路步进电机驱动模块包括步进电机驱动芯片或等效驱动电路、电流设置电路、细分设置电路、电机绕组输出接口、故障反馈电路和必要的滤波保护结构。
19、mcu 通过 step 脉冲数量控制电机步数,通过 step 脉冲频率控制运动速度,通过 dir 信号控制旋转方向,通过 en 或 nsleep 信号控制驱动状态。四路步进电机驱动模块通过 nfault 或等效信号向 mcu 反馈异常状态,以便 mcu 执行停止脉冲、关闭驱动和输出报警信息处理。
20、编码器反馈模块用于采集各路舵叶执行机构或步进电机输出端的角度变化、旋转方向和运动状态。每一路电机对应一组编码器接口,编码器接口包括供电端、接地端、a 相、b 相和可选 z 相信号。
21、a 相和 b 相信号输入 mcu 后,mcu 根据两相信号的相位超前或滞后关系判断实际旋转方向,并根据计数增减判断实际角度变化。z 相作为索引信号,用于特定位置校验或回零补充判断。编码器反馈主要用于运动状态校验、方向判断、掉步分析和外部视觉检测结果对照,不必限定为实时闭环控制。
22、编码器输入通道设置 esd 保护、串联限流电阻、rc 滤波、上拉电阻和施密特触发整形电路。
23、限位或回零模块用于接入每一路舵叶执行机构的 home 和 limit 信号。home 信号用于建立参考零位或进行回零校准,limit 信号用于检测舵叶执行机构是否到达预设运动边界。
24、在回零过程中,mcu 控制对应步进电机按预设方向低速运动,并持续读取 home信号。当 home 信号触发后,mcu 停止脉冲输出或进行零位修正,将当前位置作为参考零位。在正常运动过程中,mcu 持续检测 limit 信号,当 limit 信号触发时,停止对应通道运动,防止舵叶执行机构越界。
25、人机交互模块用于连接串口屏、触摸屏、上位机或其他显示控制设备,用于设置目标通道、目标方向、目标角度、速度参数、启动停止命令或回零命令,或者用于显示运行状态、回零状态、限位状态、故障状态和反馈数据。
26、调试模块包括 swd 下载调试接口和 uart 调试接口。swd 接口用于 mcu 程序下载、在线调试和复位控制;uart 调试接口用于输出运行状态、故障信息或与外部调试设备通信。
27、保护模块设置在电源输入、编码器输入、home/limit 输入、人机交互接口和其他外部接口处,包括过流保护、tvs 钳位、esd 防护、限流电阻、滤波电容和上拉电阻。保护模块用于提高外部接口连接、插拔和多路电机运行环境下的可靠性。
28、本发明技术方案具有的技术效果:
29、1、减少外部线束和分立模块连接。通过将主控、电源、驱动、反馈、限位/回零、人机交互和调试接口集中在同一控制装置中,降低接线错误、接触不良和重复搭建难度。
30、2、提高四路舵叶执行机构控制一致性。四路步进电机驱动模块由同一 mcu 统一输出控制信号,便于实现独立控制、顺序控制、同步启动和协同实验。
31、3、提高舵叶实际运动状态获取能力。编码器反馈、home 信号、limit 信号和驱动故障信号统一输入 mcu,使装置能够获得旋转方向、角度变化、回零状态、边界状态和异常状态。
32、4、为外部视觉检测结果提供硬件侧校验依据。mcu 输出的控制指令、编码器反馈数据和限位/回零状态可以与外部视觉检测结果进行对照,从而判断视觉检测得到的方向、角度变化或运动状态是否可靠。
33、5、提高平台复用性和后续样机化基础。统一接口定义、电源管理和保护结构有利于后续 pcb 化、样机调试、实验复现和扩展应用。
34、6、扩大应用适配范围。虽然本方案面向舵叶运动检测平台,但其四路步进电机控制、反馈采集、限位/回零和外部校验数据输出结构,也可用于其他需要多路执行机构运动控制和状态反馈的小型机电实验平台。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com