基于DSP在仿生机器蟹多关节控制系统的应用
2.2 计数器的设计
在计数器的设计过程中采用模块化的设计思想,利用MAX+plus II软件提供的可调参数化元件库(LPM-Library ofParameterizedModules),选取可调参数化计数器元件LPM-counter来设计16位计数器。在该计数器模块上共有9个并行的计数通道,每个通道都包括一个16位可预置初始值的双向可逆计数器,计数脉冲采用上升沿触发,并具有同步装载初值和异步清零的功能。计数器结构框图如图4所示。在该模块中,还包括电机QEP信号组的4倍频处理和方向判断功能电路,并且具有与DSP芯片TMS320LF2407接口的逻辑电路。
2.3 步行足足端力信号检测电路
为了实时获得躯体相对于大地坐标系的位置和姿态信息,步行机器人必须通过大量的外部传感器获得诸如倾角、离地高度等信息。在机器蟹的步行足端部安装了力传感器,利用它检测足端与物体(或地面)的接触力大小,来判断步行足是与外界物体发生碰撞还是接触地面。通过设置碰撞力信号的阈值来判断步行足是可以克服阻力按规划路径继续运动,还是改变运动方式避开障碍,或从摆动相转入支撑相。FSR(Force SensingResistors)是一种聚合体薄膜装置,其电阻值大小与其活性表面所受正压力大小成正比,这种力传感器对力的敏感程度非常高。机器蟹足端FSR检测电路如图5所示。无作用力时,FSR阻值Rs约为50MΩ,
晶体管导通,Vout输出为低电平,接近于0V;当表面受力时,阻值Rs随力的增加而减小,当Rs值满足晶体管可靠截止条件时,Vout输出高电平。要使晶体管截止?必须满足以下条件: (Vcc%26;#183;Rs)/(R1+Rs)<Vbe,即Rs<(Vbe%26;#183;R1)/(Vcc-Vbe)
3 单步行足控制系统的软件设计
在本文设计的机器蟹控制器中,采用分时集中方式和多CPU的结构。步行足控制器采用分时集中方式,由一个CPU对3条步行足的9个关节进行控制,CPU可对各关节的反馈控制策略进行协调控制,完全由软件确立各关节之间的耦合关系。而整个机器蟹的全局控制器结构为多CPU结构,由3个步行足控制器(即3个CPU控制单元)并联成伺服控制层,并由一个中央控制CPU协调控制。机器蟹步行足控制系统的单关节控制过程如图6所示。由PC机(上位机)将每一个动作任务分解为各关节转角,并每隔一个插补时间T1执行一次上下位机指令,将下一个T1时间内各指关节的目标转角指令值发送给DSP控制器(下位机)。DSP控制器将插补时间内的转角按可控精度进行周期为T2的插补细分,细分后所得任务为各个关节电机控制中断程序的实际目标指令,并在插补周期时间内实现电机转角位置伺服控制,从而完成步行足的运动控制。除此之外,控制系统软件还包括步行足轨迹规划运算、系统自检和初始化、故障判断、程序终止、力/位置信号采集处理等功能模块。
本文以仿生机器蟹为设计对象,提出了基于DSP的机器蟹多层多目标递阶控制系统方案,并对单步行足的软、硬件设计做了详细的阐述,为进一步实现自主式的仿生步行机构奠定了基础。
- 在采用FPGA设计DSP系统中仿真的重要性 (06-21)
- 基于 DSP Builder的FIR滤波器的设计与实现(06-21)
- 达芬奇数字媒体片上系统的架构和Linux启动过程(06-02)
- FPGA的DSP性能揭秘(06-16)
- 用CPLD实现DSP与PLX9054之间的连接(07-23)
- DSP+FPGA结构在雷达模拟系统中的应用(01-02)