资讯详情

机械手爪部位触觉感应系统

文章目录

  • 机械爪触感系统
    • 一、项目设计目标
    • 二、项目整体框图
    • 三、项目设计方案
      • 3.1 压敏电阻信号输出方案:
      • 3.2 放大电路方案:
      • 3.3 偏置电路方案:
      • 3.4 低通滤波方案:
      • 3.5 ADC采集方案:
      • 3.6 程序设计方案:
      • 3.7 LED蜂鸣器驱动方案:
      • 3.8 步进电机驱动方案:
      • 3.9 电源设计方案:

机械爪触感系统

一、项目设计目标

触觉传感模块根据关节机械手的爪部分设计,通过触觉传感信号反馈控制爪关节的步进电机运动,使爪可以在不损坏物体的情况下可靠牢固地抓取物体,并设置接触阈值和超阈值报警提示。设计需要根据机械结构选择合适的触觉传感器,将传感器贴在机械爪的合适位置,检测爪与物体的接触,返回电信号。同时设计触觉信号的传感接口电路,设计信号放大、滤波、A/D转换电路,使信号具有足够的信噪比,可由单片机收集,设计步进电机驱动电路、声光报警电路、单片机核心控制器和液晶显示电路与用户交互,最终设计性能应达到:爪运动控制分辨率0.01mm、测力分辨率50mN、测力量程3N

机械爪图:

1626583561510

二、项目整体框图

根据项目的框图如下:

项目的整体框图主要分解为三个部分,第一部分是设计信号生成转化电路,将压力信号转化到STM32内置ADC可采集的电压信号范围,第二部分是STM32采集压力信号进行处理IO口和SPI总线向外围电路发送控制信号,第三部分驱动电路接收控制信号LED、蜂鸣器、步进电机等驱动设备

三、项目设计方案

3.1 压敏电阻信号输出方案:

  • IMS 传感器作为可变电阻,可以通过测试电压来计算电阻的大小,也可以通过计算放大器的计算电路来计算 IMS 本设计采用以下电路:

  • 先校准电阻,测量不同压力下的电阻值数据:

    拟合数据:

    电阻和压力的最终拟合公式如下:单位为 R m ( K Ω ) , m ( g ) , F ( N ) R_m(K\mathrm{\Omega}) ,m(g),F(N) Rm(KΩ),m(g),F(N)

R m = 1 / ( 0.0007 × m ? 0.0042 ) K Ω = 1 / ( 0.0007 × ( F × 1 0 3 ) / g ? 0.0042 ) K Ω R_m=1/(0.0007\times\ m-0.0042)\ K\mathrm{\Omega}=1/(0.0007\times(F\times10^3)/g-0.0042)\ K\mathrm{\Omega} Rm=1/(0.0007× m−0.0042) KΩ=1/(0.0007×(F×103)/g−0.0042) KΩ

3.2 放大电路方案:

  • 根据前面的反相电路结果,由输出电压为3.3V确定放大电路的放大倍率为3(3.3\1.09=3.027),放大电路采用反相比例放大电路,其放大倍数为计算公式为: K f = − R 3 R 1 K_f=-\frac{R_3}{R_1} Kf​=−R1​R3​​,故取电阻值为:   R 3 = 3   K Ω , R 1 = R 2 = 1   K Ω \ R_3=3\ K\mathrm{\Omega}, R_1=R_2=1\ K\mathrm{\Omega}  R3​=3 KΩ,R1​=R2​=1 KΩ

    仿真结果如下

3.3 偏置电路方案:

偏置电路采用同向加法运算电路,通过与滑动变阻器产生的电压进行加法运算,调节输入电压的偏置,其仿真电路如下:

其输入与输出关系为: U O = ( 1 + R 6 R 4 ) ( R 5 / / R 11 R 8 + R 5 / / R 11 U I 1 + R 5 / / R 8 R 11 + R 5 / / R 8 U I 2 ) U_O=\left(1+\frac{R_6}{R_4}\right)\left(\frac{R_5//R_{11}}{R_{8+}R_5//R_{11}}U_{I1}+\frac{R_5//R_8}{R_{11+}R_5//R_8}U_{I2}\right) UO​=(1+R4​R6​​)(R8+​R5​//R11​R5​//R11​​UI1​+R11+​R5​//R8​R5​//R8​​UI2​) 其中 U I 1 U_{I1} UI1​为上级放大电路输出电压, U I 2 U_{I2} UI2​为输入的偏置电压信号,由滑动变阻器分压获得。根据计算公式和输入电压的范围,我们取: R 8 = 2   K Ω , R 4 = 2   K Ω , R 6 = 2   K Ω , R 11 = 2   K Ω , R 5 = 1   K Ω R_8=2\ K\mathrm{\Omega},R_4=2\ K\mathrm{\Omega},R_6=2\ K\mathrm{\Omega},R_{11}=2\ K\mathrm{\Omega},R_5=1\ K\mathrm{\Omega} R8​=2 KΩ,R4​=2 KΩ,R6​=2 KΩ,R11​=2 KΩ,R5​=1 KΩ

所以偏置电路的输入与输出的关系如下: U o = 1 2 ( U I 1 + U I 2 ) U_o=\frac{1}{2}\left(U_{I1}+U_{I2}\right) Uo​=21​(UI1​+UI2​)

3.4 低通滤波方案:

  • 低通滤波电路我们采用压控电压源二阶低通滤波电路,具体电路原理图如下:

​ 根据该电路图计算滤波器的各个参数,首先确定截止频率

f c = 1000 H z f_c=1000Hz fc​=1000Hz

​ 然后压控电压源二阶低通滤波电路传递函数模型选择参数: ∣ H ( S ) ∣ = K P ω 0 2 ( ω 0 2 − ω c 2 )   2 + ( α ω 0 ω c )   2 \left|H(S)\right|=\frac{K_P{\omega_0}^2}{\sqrt{(\omega_0^2-\omega_c^2)\ ^2+(\alpha\omega_0\omega_c)\ ^2}} ∣H(S)∣=(ω02​−ωc2​) 2+(αω0​ωc​ 标签: 360kf电阻

锐单商城拥有海量元器件数据手册IC替代型号,打造 电子元器件IC百科大全!

锐单商城 - 一站式电子元器件采购平台