一种用于六维力传感器的信号处理系统技术方案

本发明专利技术公开了一种用于六维力传感器的信号处理系统，信号放大模块用于对六维力传感器的六组惠斯通电桥的差分输出信号进行放大，并输出放大后的六路模拟信号；信号采集模块对信号放大模块输出的六路模拟信号进行采集，并转化为数字信号，送入数据处理模块；数据处理模块对信号采集模块采集的数据进行处理，并送入信号传输模块；信号传输模块将六维力传感器解耦后的力/力矩值或者未解耦的模拟电压值发送到对应的上位机；供电模块为所有模块供电。本发明专利技术对六维力传感器的模拟输出信号在六维力传感器内进行了处理，使其直接输出数字信号，避免了传输过程对六维力传感器的输出的干扰，同时省去了上位机与传感器间的采集卡采集环节。

A Signal Processing System for Six-Dimensional Force Sensor

【技术实现步骤摘要】
一种用于六维力传感器的信号处理系统
本专利技术涉及六维力传感器
，具体为一种用于六维力传感器的信号处理系统。
技术介绍
力传感器根据测力的维度分，可以分为单维力传感器和多维力传感器。其中，多维力传感器是能够同时测得2个或2个以上力及力矩信息的力传感器，其中应用最广泛的是六维力传感器。在众多基于不同原理设计的六维力传感器中，电阻应变型六维力传感器的使用最为普遍，其力敏感原理是电阻应变效应，即当力施加在传感器的弹性梁上时，会引起弹性梁的微小形变，因此贴在弹性体上的电阻应变片也会发生一定的变形，从而引起应变片的电阻发生变化。通过测得弹性梁上各应变片的电阻变化，即可求得三维空间上的六维力/力矩。一般来说，弹性梁上的电阻应变片都会以惠斯通电桥的形式存在，每个力/力矩维度对应一组惠斯通电桥，因此六维力传感器共有6组惠斯通电桥。然而即使在传感器满量程力/力矩的作用下，每组惠斯通电桥的输出电压为毫伏级，不便于后续数据的处理，且模拟信号易受环境干扰，同时，随着六维力传感器的使用环境逐渐复杂，操作繁琐，接线困难也是制约其使用的一个重要问题。
技术实现思路
本专利技术的目的在于解决现有六维力传感器的模拟信号易受环境干扰、数据处理不便、接线困难的技术问题，而提出一种六维力传感器的信号处理系统，将信号处理系统安装在六维力传感器内，对六维力传感器受力后产生的模拟信号输出进行放大、采集、软件自解耦和无线传输，实现多个六维力传感器在没有数据采集卡的情况下，同时与上位机进行通信。、本专利技术通过以下技术方案实现：一种用于六维力传感器的信号处理系统，包括信号放大模块、信号采集模块、数据处理模块、信号传输模块以及供电模块，其中，信号放大模块用于对六维力传感器的六组惠斯通电桥的差分输出信号进行放大，并输出放大后的六路模拟信号；信号采集模块对信号放大模块输出的六路模拟信号进行采集，并转化为数字信号，送入数据处理模块；数据处理模块对信号采集模块采集的数据进行处理，并送入信号传输模块；信号传输模块将六维力传感器解耦后的力/力矩值或者未解耦的模拟电压值发送到对应的上位机；供电模块为信号放大模块、信号采集模块、数据处理模块和信号传输模块供电。本专利技术所述信号处理系统的主控芯片为STM32F103ZET6单片机平台。本专利技术中，信号放大模块采用两级放大方式，第一级放大采用六块单片放大器放大，分别放大对应于Fx,Fy,Fz,Mx,My,Mz方向惠斯通电桥的电压信号，第一级放大使用仪用放大器AD620；第二级放大采用程控放大器AD603，程控放大器增益调节原则是送入信号采集模块的六路电压信号的满量程值保持在9V左右，调节方法为根据信号采集模块采集的实时满量程电压值，与期望值即±9V进行比较，使用STM32F103ZET6自带的DAC产生-0.5～0.5V的控制电压，实现对AD603程控放大器放大倍数的调节。第一级放大使用高输入阻抗、高共模抑制比、高精度的仪用放大器，第二级放大采用程控放大器，仪用放大器和程控放大器的放大倍数可以由系统中主控芯片的单片机自由调节，以满足后续信号采集模块采集的要求。信号放大模块主要功能是对电阻应变型六维力传感器的六组惠斯通电桥的输出信号进行放大，使信号满足后续采集模块的性能要求。模块由供电模块供电，采用±12V直流供电方式，在信号放大模块加入了滤波以及电压异常报警功能，有效减少了电源纹波电压对六维力传感器的干扰，避免了因电源电压异常导致的采集数据异常。本专利技术中，信号采集模块采用16位模数转换器AD7606，信号采集模块具有6路同步采样输入功能，A/D采样率达200KSPS，主控芯片STM32F103ZET6通过定时中断，在中断中利用串口查询AD7606采集进度，并在采集完毕时开启SPI时序进行六维力传感器的电压信号的采集。本专利技术中，数据处理模块首先对连续采集的10组六路电压信号进行数字滤波，数字滤波采用IIR无限脉冲响应低通滤波器。本专利技术中，数据处理模块中包括一个单刀双掷开关，用来选择数据处理模块的工作模式，当六维力传感器处于标定模式时，上位机需要使用六维力传感器直接输出的电压值，因此数据处理模块会直接将数字滤波后的电压值送入信号传输模块；当六维力传感器标定与解耦完毕后，处于正常工作模式时，数据处理模块会将数字滤波后的电压值代入解耦矩阵中，将解耦完毕后的六维力传感器测得的力/力矩值传入信号传输模块；数据处理模块使用的解耦算法为阶梯优化型基于耦合和分段拟合建模的多维力传感器解耦算法。数据处理模块的功能首先是对信号采集模块的传入的六维力传感器电压数据进行数字滤波，然后判断传感器的工作模式，若传感器处于标定模式，则直接输出滤波后的电压值，并打包准备传输；若传感器处于正常使用模式，则将电压数据代入解耦矩阵中进行解耦，将六维力传感器输出的电压值直接转化为力/力矩输出值，并且打包准备传输。本专利技术中，信号传输模块使用ALK8266WIFI模块，信号传输模块工作在站点模式，与上位机使用TCP/IP协议进行通讯，各六维力传感器上的WIFI模块作为客户端，上位机作为服务器端，信号传输模块与上位机的通讯流程为：首先六维力传感器内的8266WIFI模块会自动连入上位机所在的局域网内，等待上位机开启端口监听，随后上位机根据六维力传感器的数量建立若干个socket套接字，开始监听若干个固定的端口，各六维力传感器的WIFI模块在上位机网络端口开启后，就会通过上位机的内网IP和相应端口号，与六维力传感器的信号传输模块建立TCP/IP通讯连接，并等待上位机发送控制指令。信号传输模块的主要功能是将解耦后六维力传感器的力/力矩输出值或者滤波后的电压值通过WIFI无线传输的方式发送到上位机，上位机与多个传感器之间构建多点系统，上位机作为主机，各个传感器作为从机。上位机通过发送带有传感器ID识别码的指令，控制各个传感器分时向主机发送测得的力/力矩值，实现多个传感器数据的同步采集。采用WIFI无线传输的方式，避免了传感器与上位机必须使用引线连接的问题，扩展了六维力传感器的使用环境，减轻了安装困难的问题。本专利技术中，上位机与多个六维力传感器建立连接后，通过对逐个传感器发送控制指令，控制其是否发送力/力矩数据，同时使用CRC码对传输的数据进行校验，若传输数据有误则重新发送，当某个传感器因损坏或者关闭电源而与上位机连接中断时，上位机将自动更新系统状态，关闭该Socket套接字。本专利技术中，供电模块本身由220V市电供电或者12V锂电池供电；当使用220V市电供电时，通过220V电源适配器将电压转化为12V直流电，当使用12V锂电池供电时，直接连接供电模块；供电模块上带有用于检测当前的输入电压的电压检测显示模块，电压检测显示模块中的DC-DC转换电路将电压转换为±12V直流电，为整个系统供电。与现有技术相比，本专利技术的有益效果在于：本专利技术使六维力传感器采集的信号更加可靠，测量数据更加精确，使用不受环境约束，安装拆卸更加方便，并且实现多传感器的同时采集。本专利技术对六维力传感器的模拟输出信号在六维力传感器内进行了处理，使其直接输出数字信号，避免了传输过程对六维力传感器的输出的干扰，同时省去了上位机与传感器间的采集卡采集环节。本专利技术在系统内对六维力传感器的电压输出值进行了解耦计算，上位机直接接本文档来自技高网...

【技术保护点】
1.一种用于六维力传感器的信号处理系统，其特征在于，包括信号放大模块、信号采集模块、数据处理模块、信号传输模块以及供电模块，其中，信号放大模块用于对六维力传感器的六组惠斯通电桥的差分输出信号进行放大，并输出放大后的六路模拟信号；信号采集模块对信号放大模块输出的六路模拟信号进行采集，并转化为数字信号，送入数据处理模块；数据处理模块对信号采集模块采集的数据进行处理，并送入信号传输模块；信号传输模块将六维力传感器解耦后的力/力矩值或者未解耦的模拟电压值发送到对应的上位机；供电模块为信号放大模块、信号采集模块、数据处理模块和信号传输模块供电。

【技术特征摘要】
1.一种用于六维力传感器的信号处理系统，其特征在于，包括信号放大模块、信号采集模块、数据处理模块、信号传输模块以及供电模块，其中，信号放大模块用于对六维力传感器的六组惠斯通电桥的差分输出信号进行放大，并输出放大后的六路模拟信号；信号采集模块对信号放大模块输出的六路模拟信号进行采集，并转化为数字信号，送入数据处理模块；数据处理模块对信号采集模块采集的数据进行处理，并送入信号传输模块；信号传输模块将六维力传感器解耦后的力/力矩值或者未解耦的模拟电压值发送到对应的上位机；供电模块为信号放大模块、信号采集模块、数据处理模块和信号传输模块供电。2.根据权利要求1所述的一种用于六维力传感器的信号处理系统，其特征在于，所述信号处理系统的主控芯片为STM32F103ZET6单片机平台。3.根据权利要求2所述的一种用于六维力传感器的信号处理系统，其特征在于，信号放大模块采用两级放大方式，第一级放大采用六块单片放大器放大，分别放大对应于Ff,Fy,Fz,Mx,My,Mz方向惠斯通电桥的电压信号，第一级放大使用仪用放大器AD620；第二级放大采用程控放大器AD603，程控放大器增益调节原则是送入信号采集模块的六路电压信号的满量程值保持在9V左右，调节方法为根据信号采集模块采集的实时满量程电压值，与期望值即±9V进行比较，使用STM32F103ZET6自带的DAC产生-0.5～0.5V的控制电压，实现对AD603程控放大器放大倍数的调节。4.根据权利要求2所述的一种用于六维力传感器的信号处理系统，其特征在于，信号采集模块采用16位模数转换器AD7606，信号采集模块具有6路同步采样输入功能，A/D采样率达200KSPS，主控芯片STM32F103ZET6通过定时中断，在中断中利用串口查询AD7606采集进度，并在采集完毕时开启SPI时序进行六维力传感器的电压信号的采集。5.根据权利要求2所述的一种用于六维力传感器的信号处理系统，其特征在于，数据处理模块首先对连续采集的10组六路电压信号进行数字滤波，数字滤波采用IIR无限脉冲响应低通滤波器。6.根据权利要求5所述的一种用于六维力传感器的信号处理系统，...

【专利技术属性】
技术研发人员：陈望隆，杨述焱，胡权，孙东杰，李丹若，宋爱国，
申请(专利权)人：东南大学，
类型：发明
国别省市：江苏,32