一种带DSP复位安全防护的舵机控制器的制作方法
本发明涉及舵机控制,特别是涉及一种带dsp复位安全防护的舵机控制器。
背景技术:
1、当前高精度舵机控制器普遍采用dsp作为主控核心,依托dsp的高速运算能力与高精度pwm外设,通过输出pwm脉冲信号实现对舵机转角与速度的精准控制;为实现弱电主控回路与强电电机驱动回路之间的电气隔离,现有舵机控制器普遍采用高速光耦完成pwm信号的隔离传输。
2、现有舵机控制器的pwm信号传输与控制架构主要分为三类:第一类是在dsp的pwm输出端与后端驱动电路之间直接设置隔离光耦,利用高速光耦实现pwm信号隔离传输,因高速光耦输出逻辑与输入信号反相,后端驱动电路需配置逻辑反相电路,将光耦输出信号转换为与dsp输出同相的pwm信号后输入电机驱动模块,该方案未针对dsp复位高阻态进行电平锁定设计;第二类是选用自带io引脚状态锁定功能的专用dsp芯片或fpga芯片,通过芯片内部硬件安全模块,在复位阶段将pwm输出引脚强制设定为确定电平,避免引脚进入高阻态;第三类是在光耦输出端与反相逻辑电路之间增设触发器、锁存器等逻辑芯片,在dsp异常复位时触发锁存器工作,将光耦输出的pwm信号强制锁存为高电平,经反相后输出安全低电平。
3、上述现有技术存在明显缺陷:其一,通用型dsp芯片在异常复位时,包括pwm输出引脚在内的全部gpio引脚会进入高阻态,引脚对外呈现极高阻抗,无法输出确定高低电平,易导致光耦内部发光二极管误导通,光耦输出持续低电平,经反相后触发舵机满转开环运行,极易造成舵机传动机构损坏;其二,自带io复位锁定功能的专用dsp芯片,价格比通用dsp芯片高出30%至200%,大幅提升控制器硬件成本,且芯片选型范围狭窄,现有主流通用dsp均不具备该引脚锁定功能,无法兼容现有成熟主控方案;其三,额外增设逻辑芯片会引入pwm信号传输延迟,改变信号占空比,直接降低舵机控制精度,同时锁存器易受现场电磁干扰误触发,导致正常工作时pwm信号被锁死,引发舵机运行故障。
技术实现思路
1、针对上述技术问题,本发明实施例提供一种带dsp复位安全防护的舵机控制器,旨在实现舵机全工作周期的状态锁定,提升控制器安全性与可靠性;提供结构极简、成本极低、易于实现的硬件方案,无需修改dsp主控程序、无需增设复杂芯片与电路,适配现有主流硬件架构,具备强通用性;通过合理的器件参数匹配,确保防护电路不影响正常工作时pwm信号的频率、占空比、高低电平幅值、传输精度与响应速度,实现安全防护与控制性能的双重兼顾。本发明采用的技术方案如下:
2、一种带dsp复位安全防护的舵机控制器,该舵机控制器包括dsp电源电路、dsp信号处理电路及外围电路、485通讯电路、can总线接口电路、pwm信号光耦隔离防护电路;
3、dsp电源电路,由外部5v供电输入、ldo电压稳压器、滤波电容组成,用于为舵机控制器内所有数字与模拟器件提供稳定工作电压;
4、dsp信号处理电路,以通用dsp芯片为核心,配套包含dsp时钟电路、复位电路、仿真接口电路,共同构成完整的最小运行系统,承担指令解析、数据运算、信号采集、pwm与方向信号输出的控制功能;
5、485通讯电路,作为与外部上位控制系统进行数据交互的标准串行通信接口单元,用于实现舵机控制器与弹上信息处理器之间的双向数据传输;
6、can总线接口电路,采用can总线差分通信方式,用于dsp芯片与角位移传感器之间实现实时数据交互;
7、pwm信号光耦隔离防护电路,用于pwm信号电气隔离传输与异常复位保护。
8、可选地,dsp芯片用于接收485通讯电路传入的上位机控制指令;接收can总线接口电路采集的角位移传感器反馈信号;对指令信号与反馈信号进行误差解算与闭环控制运算;根据运算结果输出pwm速度控制信号与fr方向控制信号;在异常复位时,进入高阻态输出状态。
9、可选地,dsp信号处理电路接收上位机指令,完成指令解码、数据校验与状态识别;通过can总线接口电路实时采集舵机角位移、转速的反馈信息,为闭环控制提供依据;根据指令与反馈的误差,进行实时运算,动态调整输出信号的占空比与方向;输出pwm信号控制舵机转速,输出fr信号控制舵机运动方向。
10、可选地,当dsp信号处理电路及外围电路中作为主控核心的dsp芯片发生异常复位时,其pwm输出引脚进入高阻态,由pwm信号光耦隔离防护电路实现安全保护。
11、可选地,485通讯电路包括485通讯控制器、485通讯接口、总线匹配电阻、滤波与保护器件。
12、可选地,can总线接口电路包括can收发器、can总线接口端子、总线阻抗匹配电阻、esd静电保护器件。
13、可选地,can收发器用于将dsp芯片输出的ttl电平can发送信号转换为can总线差分信号,同时将总线上的can差分信号转换为dsp芯片可识别的ttl电平接收信号,完成电气隔离与电平转换。
14、可选地,所述pwm信号光耦隔离防护电路以高速光耦ht2355为核心隔离器件,由限流电阻、下拉电阻、高速光耦ht2355、供电回路构成。
15、可选地,当dsp芯片异常复位,dsp芯片的pwm输出引脚进入高阻态时,所述pwm信号光耦隔离防护电路通过下拉电阻与限流电阻形成导通回路,强制光耦输入侧获得稳定驱动电流,使光耦输出固定高电平,经电机驱动模块反相后输出低电平,强制舵机电机停止转动。
16、可选地,当dsp芯片未发生复位,dsp芯片的pwm1引脚正常输出高低电平交替的pwm信号,pwm信号经限流电阻驱动高速光耦ht2355按信号频率导通与关断。
17、本发明提供了一种带dsp复位安全防护的舵机控制器,本发明的实施例提供的技术方案至少带来以下有益效果:
18、(1)硬件成本低:仅需增设一个参数匹配的贴片电阻,远低于现有专用芯片、逻辑芯片、开关电路等方案,几乎不增加控制器硬件成本。
19、(2)可靠性更高:采用无源电阻实现防护,无有源芯片的失效风险,不引入新的失效节点,无需时序匹配,纯硬件自动实现安全锁定,避免时序异常导致的防护失效。
20、(3)通用性强:无需修改现有dsp+光耦隔离舵机控制架构的核心电路,可直接应用于新设备设计与存量设备升级改造,适配主流通用型dsp芯片。
21、(4)控制性能无损耗:下拉电阻参数经优化匹配,正常工作时对pwm信号的电平、占空比、频率、传输精度与响应速度无任何影响,安全防护与控制精度双重兼顾。
22、应当理解的是,以上的一般描述和后文的细节描述仅是示例性和解释性的,并不能限制本申请。
1.一种带dsp复位安全防护的舵机控制器,其特征在于,该舵机控制器包括dsp电源电路、dsp信号处理电路及外围电路、485通讯电路、can总线接口电路、pwm信号光耦隔离防护电路;
2.根据权利要求1所述的带dsp复位安全防护的舵机控制器,其特征在于,dsp芯片用于接收485通讯电路传入的上位机控制指令;接收can总线接口电路采集的角位移传感器反馈信号;对指令信号与反馈信号进行误差解算与闭环控制运算;根据运算结果输出pwm速度控制信号与fr方向控制信号;在异常复位时,进入高阻态输出状态。
3.根据权利要求2所述的带dsp复位安全防护的舵机控制器,其特征在于,dsp信号处理电路接收上位机指令,完成指令解码、数据校验与状态识别;通过can总线接口电路实时采集舵机角位移、转速的反馈信息,为闭环控制提供依据;根据指令与反馈的误差,进行实时运算,动态调整输出信号的占空比与方向;输出pwm信号控制舵机转速,输出fr信号控制舵机运动方向。
4.根据权利要求3所述的带dsp复位安全防护的舵机控制器,其特征在于,当dsp信号处理电路及外围电路中作为主控核心的dsp芯片发生异常复位时,其pwm输出引脚进入高阻态,由pwm信号光耦隔离防护电路实现安全保护。
5.根据权利要求1所述的带dsp复位安全防护的舵机控制器,其特征在于,485通讯电路包括485通讯控制器、485通讯接口、总线匹配电阻、滤波与保护器件。
6.根据权利要求1所述的带dsp复位安全防护的舵机控制器,其特征在于,can总线接口电路包括can收发器、can总线接口端子、总线阻抗匹配电阻、esd静电保护器件。
7.根据权利要求6所述的带dsp复位安全防护的舵机控制器,其特征在于,can收发器用于将dsp芯片输出的ttl电平can发送信号转换为can总线差分信号,同时将总线上的can差分信号转换为dsp芯片可识别的ttl电平接收信号,完成电气隔离与电平转换。
8.根据权利要求1所述的带dsp复位安全防护的舵机控制器,其特征在于,所述pwm信号光耦隔离防护电路以高速光耦ht2355为核心隔离器件,由限流电阻、下拉电阻、高速光耦ht2355、供电回路构成。
9.根据权利要求8所述的带dsp复位安全防护的舵机控制器,其特征在于,当dsp芯片异常复位,dsp芯片的pwm输出引脚进入高阻态时,所述pwm信号光耦隔离防护电路通过下拉电阻与限流电阻形成导通回路,强制光耦输入侧获得稳定驱动电流,使光耦输出固定高电平,经电机驱动模块反相后输出低电平,强制舵机电机停止转动。
10.根据权利要求8所述的带dsp复位安全防护的舵机控制器,其特征在于,当dsp芯片未发生复位,dsp芯片的pwm1引脚正常输出高低电平交替的pwm信号,pwm信号经限流电阻驱动高速光耦ht2355按信号频率导通与关断。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com