一种基于STM32F407ZET6的木球挥杆速度检测系统技术方案

一种基于STM32F407ZET6的木球挥杆速度检测系统，包括TFT触摸屏控制模块、MPU‑6050陀螺仪采集角速度模块和数据处理模块；所述TFT触摸屏控制模块中，计算屏幕触点坐标，测得的电压由ADC转化为数字信号，再进行处理作为坐标判断触点的实际位置；所述MPU‑6050陀螺仪采集角速度模块中，定义坐标系；所述数据处理模块中，MPU‑6050陀螺仪返回的数据经过转换得到实际测量的角速度数据。本发明专利技术提供了一种有效检测木球挥杆速度的基于STM32F407ZET6的木球挥杆速度检测系统。

A Wooden Ball Swing Speed Detection System Based on STM32F407ZET6

A wood ball swing speed detection system based on STM32F407ZET6 includes TFT touch screen control module, MPU 6050 gyroscope acquisition angular speed module and data processing module. In the TFT touch screen control module, the screen contact coordinates are calculated, the measured voltage is converted from ADC to digital signal, and then processed to determine the actual position of the contact points as coordinates. In the acquisition angular velocity module, the coordinate system is defined, and in the data processing module, the data returned by MPU 6050 gyroscope is converted to the actual measured angular velocity data. The invention provides a wooden ball swing speed detection system based on STM32F407ZET6, which can effectively detect the wooden ball swing speed.

【技术实现步骤摘要】
一种基于STM32F407ZET6的木球挥杆速度检测系统
本专利技术涉及单片机嵌入式实时数据采集及处理、数据可视化等技术，尤其是一种基于STM32F407ZET6的木球挥杆速度检测系统。
技术介绍
木球运动是一项新兴的运动项目，由于其独特的运动魅力和锻炼价值，迅速普及开来，深受各国人民的欢迎。木球运动已从亚洲发展到了全世界，至今已举办多次国际竞赛。然而，许多的木球运动员和爱好者受限于时间、地点等种种因素，难以广泛的获得具有针对性的指导，运动水平的进步被拖累。而如果有一个便携的设备能够实时读取木球运动者在挥杆击打木球时的实时速度，则可以较为方便快捷的反映运动者对于木球杆的控制水平，进而通过对比历史运动数据和他人运动数据，得到具有针对性的木球挥杆技术优化的建议。
技术实现思路
为了克服已有及时无法实时检测木球挥杆速度的不足,本专利技术提供了一种有效检测木球挥杆速度的基于STM32F407ZET6的木球挥杆速度检测系统。本专利技术解决其技术问题所采用的技术方案是：一种基于STM32F407ZET6的木球挥杆速度检测系统，所述系统包括TFT触摸屏控制模块、MPU-6050陀螺仪采集角速度模块和数据处理模块；所述TFT触摸屏控制模块中，屏幕触点坐标计算过程如下：计算Y坐标，在Y+电极施加驱动电压Vdrive，Y-电极接地，X+作为引出端测量得到接触点的电压，由于ITO层均匀导电，触点电压与Vdrive电压之比等于触点Y坐标与屏高度之比；计算X坐标，在X+电极施加驱动电压Vdrive，X-电极接地，Y+做为引出端测量得到接触点的电压，由于ITO层均匀导电，触点电压与Vdrive电压之比等于触点X坐标与屏宽度之比；测得的电压由ADC转化为数字信号，再进行处理作为坐标判断触点的实际位置；所述MPU-6050陀螺仪采集角速度模块中，定义坐标系如下：令芯片表面朝向自己，将其表面文字转至正确角度，此时，以芯片内部中心为原点，水平向右的为X轴，竖直向上的为Y轴，指向自己的为Z轴，三轴角速度对应的地址如下：0x43为绕X轴旋转的角速度GYR_X0x45为绕Y轴旋转的角速度GYR_Y0x47为绕Z轴旋转的角速度GYR_Z绕X、Y和Z三个座标轴旋转的角速度分量GYR_X、GYR_Y和GYR_Z均为16位有符号整数；从原点向旋转轴方向看去，取正值时为顺时针旋转，取负值时为逆时针旋转；三个角速度分量均以“度/秒”为单位，能够表示的角速度范围，即倍率统一设定；所述数据处理模块中，MPU-6050陀螺仪返回的数据经过转换得到实际测量的角速度数据。进一步，所述数据处理模块中，对角速度值进行滤波，考虑到传感器噪声为高斯噪声，因此选用卡尔曼滤波对角速度数据进行处理。再进一步，所述卡尔曼滤波过程中，先引入一个离散控制过程的系统，该系统用一个线性随机微分方程来描述：X(k)＝AX(k-1)+BU(k)+W(k)，再加上系统的测量值：Z(k)＝HX(k)+V(k)；其中，X(k)是k时刻的系统状态，U(k)是k时刻对系统的控制量；A和B是系统参数，对于多模型系统，它们为矩阵；Z(k)是k时刻的测量值，H是测量系统的参数，对于多测量系统，H为矩阵；W(k)和V(k)分别表示过程和测量的噪声，它们被假设成高斯白噪声，covariance分别是Q，R；用covariances来估算系统的最优化输出，首先利用系统的过程模型，来预测下一状态的系统；假设现在的系统状态是k，根据系统的模型，基于系统的上一状态而预测出现在状态：X(k|k-1)＝AX(k-1|k-1)+BU(k)…(1)式(1)中，X(k|k-1)是利用上一状态预测的结果，X(k-1|k-1)是上一状态最优的结果，U(k)为现在状态的控制量，如果没有控制量，它可以为0；用P表示covariance：P(k|k-1)＝AP(k-1|k-1)A’+Q(2)式(2)中，P(k|k-1)是X(k|k-1)对应的covariance，P(k-1|k-1)是X(k-1|k-1)对应的covariance，A’表示A的转置矩阵，Q是系统过程的covariance；得到了现在状态的预测结果，然后再收集现在状态的测量值；结合预测值和测量值，得到现在状态(k)的最优化估算值X(k|k)：X(k|k)＝X(k|k-1)+Kg(k)(Z(k)-HX(k|k-1))……(3)其中Kg为卡尔曼增益(KalmanGain)：Kg(k)＝P(k|k-1)H’/(HP(k|k-1)H’+R)………(4)为了卡尔曼滤波器不断的运行下去直到系统过程结束，还要更新k状态下X(k|k)的covariance：P(k|k)＝(I-Kg(k)H)P(k|k-1)………(5)其中I为1的矩阵，对于单模型单测量，I＝1；当系统进入k+1状态时，P(k|k)就是式子(2)的P(k-1|k-1)；这样就可以自回归的运算下去。所述TFT触摸屏控制模块中，采用5点中值滤波，即当前时刻的x坐标将由前4个时刻的点的x坐标和当前时刻实际采集到的x坐标中值决定，当前时刻的y坐标将由前4个时刻的点的y坐标和当前时刻实际采集到的y坐标中值决定，操作如下：将前4个时刻与当前时刻的x、y的坐标值存入数组中，然后将x、y数组排序，取其下标为2的元素值并作为当前时刻值，不断重复该操作即可。本专利技术中，本专利技术利用意法半导体公司的STM32F407ZET6这款基于ARMCortexTM-M4内核的处理器，结合TFT触摸屏，MPU-6050陀螺仪等一系列外部设备，实现对进行木球运动时的挥杆速度的有效采集，经过STM32F407ZET6内核对数据进行滤波与换算，得到最终结果，并利用显示屏显示数据，以达到数据可视化的目的。本专利技术的有益效果主要表现在：获得更精确的角速度值，实现高精度控制。附图说明图1是基于STM32F407ZET6的木球挥杆速度检测系统的原理图。具体实施方式下面结合附图对本专利技术作进一步描述。参照图1，一种基于STM32F407ZET6的木球挥杆速度检测系统，包括TFT触摸屏控制模块、MPU-6050陀螺仪采集角速度模块和数据处理模块；所述TFT触摸屏控制模块中，屏幕触点坐标计算过程如下：计算Y坐标，在Y+电极施加驱动电压Vdrive，Y-电极接地，X+作为引出端测量得到接触点的电压，由于ITO层均匀导电，触点电压与Vdrive电压之比等于触点Y坐标与屏高度之比；计算X坐标，在X+电极施加驱动电压Vdrive，X-电极接地，Y+做为引出端测量得到接触点的电压，由于ITO层均匀导电，触点电压与Vdrive电压之比等于触点X坐标与屏宽度之比；测得的电压由ADC转化为数字信号，再进行处理作为坐标判断触点的实际位置；在实际情况中，TFT屏幕触点坐标存在随机误差，因此需要减小误差影响，根据误差的特性，采用的算法是5点中值滤波，即当前时刻的x坐标将由前4个时刻的点的x坐标和当前时刻实际采集到的x坐标中值决定，当前时刻的y坐标将由前4个时刻的点的y坐标和当前时刻实际采集到的y坐标中值决定，操作如下：将前4个时刻与当前时刻的x、y的坐标值存入数组中，然后将x、y数组排序，取其下标为2的元素值并作为当前时刻值，不断重复该操作即可。所述MPU-6050陀螺仪采集角速度模块中，MPU-6050系列本文档来自技高网...

【技术保护点】
1.一种基于STM32F407ZET6的木球挥杆速度检测系统，其特征在于，所述系统包括TFT触摸屏控制模块、MPU‑6050陀螺仪采集角速度模块和数据处理模块；所述TFT触摸屏控制模块中，屏幕触点坐标计算过程如下：计算Y坐标，在Y+电极施加驱动电压Vdrive，Y‑电极接地，X+作为引出端测量得到接触点的电压，由于ITO层均匀导电，触点电压与Vdrive电压之比等于触点Y坐标与屏高度之比；计算X坐标，在X+电极施加驱动电压Vdrive，X‑电极接地，Y+做为引出端测量得到接触点的电压，由于ITO层均匀导电，触点电压与Vdrive电压之比等于触点X坐标与屏宽度之比；测得的电压由ADC转化为数字信号，再进行处理作为坐标判断触点的实际位置；所述MPU‑6050陀螺仪采集角速度模块中，定义坐标系如下：令芯片表面朝向自己，将其表面文字转至正确角度，此时，以芯片内部中心为原点，水平向右的为X轴，竖直向上的为Y轴，指向自己的为Z轴，三轴角速度对应的地址如下：0x43为绕X轴旋转的角速度GYR_X0x45为绕Y轴旋转的角速度GYR_Y0x47为绕Z轴旋转的角速度GYR_Z绕X、Y和Z三个座标轴旋转的角速度分量GYR_X、GYR_Y和GYR_Z均为16位有符号整数；从原点向旋转轴方向看去，取正值时为顺时针旋转，取负值时为逆时针旋转；三个角速度分量均以“度/秒”为单位，能够表示的角速度范围，即倍率统一设定；所述数据处理模块中，MPU‑6050陀螺仪返回的数据经过转换得到实际测量的角速度数据。...

【技术特征摘要】
1.一种基于STM32F407ZET6的木球挥杆速度检测系统，其特征在于，所述系统包括TFT触摸屏控制模块、MPU-6050陀螺仪采集角速度模块和数据处理模块；所述TFT触摸屏控制模块中，屏幕触点坐标计算过程如下：计算Y坐标，在Y+电极施加驱动电压Vdrive，Y-电极接地，X+作为引出端测量得到接触点的电压，由于ITO层均匀导电，触点电压与Vdrive电压之比等于触点Y坐标与屏高度之比；计算X坐标，在X+电极施加驱动电压Vdrive，X-电极接地，Y+做为引出端测量得到接触点的电压，由于ITO层均匀导电，触点电压与Vdrive电压之比等于触点X坐标与屏宽度之比；测得的电压由ADC转化为数字信号，再进行处理作为坐标判断触点的实际位置；所述MPU-6050陀螺仪采集角速度模块中，定义坐标系如下：令芯片表面朝向自己，将其表面文字转至正确角度，此时，以芯片内部中心为原点，水平向右的为X轴，竖直向上的为Y轴，指向自己的为Z轴，三轴角速度对应的地址如下：0x43为绕X轴旋转的角速度GYR_X0x45为绕Y轴旋转的角速度GYR_Y0x47为绕Z轴旋转的角速度GYR_Z绕X、Y和Z三个座标轴旋转的角速度分量GYR_X、GYR_Y和GYR_Z均为16位有符号整数；从原点向旋转轴方向看去，取正值时为顺时针旋转，取负值时为逆时针旋转；三个角速度分量均以“度/秒”为单位，能够表示的角速度范围，即倍率统一设定；所述数据处理模块中，MPU-6050陀螺仪返回的数据经过转换得到实际测量的角速度数据。2.如权利要求1所述的基于STM32F407ZET6的木球挥杆速度检测系统，其特征在于，所述数据处理模块中，对角速度值进行滤波，考虑到传感器噪声为高斯噪声，因此选用卡尔曼滤波对角速度数据进行处理。3.如权利要求2所述的基于STM32F407ZET6的木球挥杆速度检测系统，其特征在于，所述卡尔曼滤波过程中，先引入一个离散控制过程的系统，该系统用一个线性随机微分方程来描述：X(k)＝AX(k-1)+BU(k)+W(k)，再加上系统的测量值：Z(k)＝HX(k)+V(k)；其中，X(k)是k时刻的系统状态，U(k)是k时刻对系统的控制量；A和B是系统参数，对于多模型系统，它们为矩阵；Z(k)是k时刻的测量...

【专利技术属性】
技术研发人员：王华梁，何德峰，莫卓锐，黄雨薇，
申请(专利权)人：浙江工业大学，
类型：发明
国别省市：浙江,33