资源简介
恩智浦全国大学生智能车竞赛直立参考代码。欢迎下载,仅供参考。
恩智浦全国大学生智能车竞赛直立参考代码。欢迎下载,仅供参考。
代码片段和文件信息
#include “include.h“
#include “CollectDate.h“
int nGravityMax=2856;
int nGravityMin=900;
unsigned int ATD_Data_Buf[21][2]={0};
unsigned int ATD_Data_mid[3]={0};
unsigned int GRAVITY_dataAR1_data;
int VOLTAGE_GRAVITY;
int nGravityOffset;
int VOLTAGE_GYRO;
int g_nGyroscopeOffset;
extern float g_fGravityAngleg_fYGravityAngleg_fCarSpeedAngle=0;
extern float g_fGyroAngleIntegralg_fSpeedControlIntegralg_fGyroAngleSpeedg_fGyroAngle;
float fDeltaValue;
float angleangle_dot;//互补滤波
float bias_cf;
float dt=0.005;
extern float CarAngle;
float kai kai1;
void Read_AD(void) //读取陀螺仪和加速度计AD值
{
unsigned char i;
for(i=0;i<=20;i++)
{
ATD_Data_Buf[i][0]=ad_once(ADC0SE8 ADC_12bit); //B0 陀螺仪通道 AR1
ATD_Data_Buf[i][1]=ad_once(ADC0SE9 ADC_12bit); //B1 Z轴加速度计
}
}
void Get_AD_mid(void) //中值滤波
{
unsigned char ijkmin;
unsigned int t;
for(j=0;j<2;j++)
{
for(i=0;i<20;i++)
{
min=i;
for(k=i+1;k<21;k++)
{
if(ATD_Data_Buf[k][j] {
min=k;
}
}
if(min!=i)
{
t=ATD_Data_Buf[i][j];
ATD_Data_Buf[i][j]=ATD_Data_Buf[min][j];
ATD_Data_Buf[min][j]=t;
}
}
ATD_Data_mid[j]=ATD_Data_Buf[10][j];
}
}
void AVE(void)
{
int SUM_AR1=0SUM_GRAZ=0;
u8 i;
for(i=0;i<10;i++)
{
Read_AD();
Get_AD_mid();
SUM_AR1+=ATD_Data_mid[0]; //陀螺仪值
SUM_GRAZ+=ATD_Data_mid[1]; //加速度值
}
AR1_data=SUM_AR1/10; //陀螺仪值
GRAVITY_data=SUM_GRAZ/10; //加速度值
//printf(“2=%d\n“GRAVITY_data);
}
/***********互补滤波****************/
void complement_filter(float angle_m_cffloat gyro_m_cf)
{
bias_cf*=0.001; //陀螺仪零飘低通滤波;500次均值;0.998
bias_cf+=gyro_m_cf*0.09; //0.002
angle_dot=gyro_m_cf-bias_cf;
angle=(angle+angle_dot*dt)*0.95+angle_m_cf*0.04;
//加速度低通滤波;20次均值;按100次每秒计算,低通5Hz;0.90 0.05
CarAngle=angle;
}
/*********************Get_ATD_mid**************************/
void AngleCalculate(void)
{
VOLTAGE_GRAVITY=GRAVITY_Receive();
//printf(“%d\n“VOLTAGE_GRAVITY1);
//加速度传感器角度输出
g_fGravityAngle=(float)(VOLTAGE_GRAVITY-1838)*GRAVITY_ANGLE_RATIO;
//陀螺仪角速度
VOLTAGE_GYRO=AR1_Receive();
//VOLTAGE_GYR1=ad_ave(ADC0SE12 ADC_12bit20);
//printf(“g_nGyroscopeOffset=%d\n“g_nGyroscopeOffset);
g_fGyroAngleSpeed=(float)((VOLTAGE_GYRO-2852)*0.45);//0.123陀螺仪比例参数021
//g_fGyroAngle=g_fGyroAngleSpeed*0.005; //求陀螺仪比例系数
g_fGyroAngle=g_fGyroAngleIntegral;
fDeltaValue = (g_fGravityAngle - g_fGyroAngle)/0.7;
//g_fGyroAngleIntegral+=((g_fGravityAngle-g_fGyroAngleIntegral)*(1.00+Scan_Key0())+g_fGyroAngleSpeed)*(0.21+Scan_Key0());
g_fGyroAngleIntegral+=(g_fGyroAngleSpeed+fDeltaValue)*0.005;
//complement_filter(g_fGyroAngleIntegralg_f
属性 大小 日期 时间 名称
----------- --------- ---------- ----- ----
目录 0 2016-03-15 22:02 寒假调直立 - 16-03-15速度闭环\
目录 0 2016-03-15 22:02 寒假调直立 - 16-03-15速度闭环\build\
目录 0 2016-03-15 22:02 寒假调直立 - 16-03-15速度闭环\build\config files\
文件 2030 2015-03-30 11:51 寒假调直立 - 16-03-15速度闭环\build\config files\128KB_Pflash.icf
文件 2206 2010-11-12 03:41 寒假调直立 - 16-03-15速度闭环\build\config files\128KB_Pflash_128KB_Dflash.icf
文件 2035 2012-02-28 15:33 寒假调直立 - 16-03-15速度闭环\build\config files\128KB_Ram.icf
文件 2030 2010-10-28 03:30 寒假调直立 - 16-03-15速度闭环\build\config files\256KB_Pflash.icf
文件 2214 2012-03-01 20:12 寒假调直立 - 16-03-15速度闭环\build\config files\256KB_Pflash_256KB_Dflash.icf
文件 2024 2010-10-28 03:30 寒假调直立 - 16-03-15速度闭环\build\config files\32KB_Ram.icf
文件 2041 2012-03-01 18:46 寒假调直立 - 16-03-15速度闭环\build\config files\512KB_Pflash.icf
文件 2217 2010-11-12 03:41 寒假调直立 - 16-03-15速度闭环\build\config files\64KB_Pflash_64KB_Dflash.icf
文件 2024 2010-10-28 03:30 寒假调直立 - 16-03-15速度闭环\build\config files\64KB_Ram.icf
文件 3463 2012-03-08 21:04 寒假调直立 - 16-03-15速度闭环\build\config files\fire_RAM_K60N512.icf
文件 3441 2012-03-08 21:04 寒假调直立 - 16-03-15速度闭环\build\config files\fire_ROM_K60N512.icf
文件 669 2012-03-10 23:38 寒假调直立 - 16-03-15速度闭环\build\iar.h
目录 0 2016-03-15 22:02 寒假调直立 - 16-03-15速度闭环\build\led_demo\
目录 0 2016-03-15 22:02 寒假调直立 - 16-03-15速度闭环\build\led_demo\Debug\
目录 0 2016-03-15 22:02 寒假调直立 - 16-03-15速度闭环\build\led_demo\Debug\Exe\
文件 45603 2016-03-12 20:56 寒假调直立 - 16-03-15速度闭环\build\led_demo\Debug\Exe\.hex
文件 21994 2015-03-28 10:54 寒假调直立 - 16-03-15速度闭环\build\led_demo\Debug\Exe\fire_gpio_demo.hex
文件 284536 2016-03-12 20:56 寒假调直立 - 16-03-15速度闭环\build\led_demo\Debug\Exe\fire_gpio_demo.out
文件 16243 2016-03-12 20:57 寒假调直立 - 16-03-15速度闭环\build\led_demo\Debug\Exe\fire_gpio_demo.sim
目录 0 2016-03-15 22:02 寒假调直立 - 16-03-15速度闭环\build\led_demo\Debug\List\
文件 34922 2016-03-12 20:56 寒假调直立 - 16-03-15速度闭环\build\led_demo\Debug\List\fire_gpio_demo.map
目录 0 2016-03-15 22:02 寒假调直立 - 16-03-15速度闭环\build\led_demo\Debug\Obj\
文件 27156 2015-07-20 11:56 寒假调直立 - 16-03-15速度闭环\build\led_demo\Debug\Obj\adc.o
文件 11376 2015-07-20 11:56 寒假调直立 - 16-03-15速度闭环\build\led_demo\Debug\Obj\alloc.o
文件 16528 2015-07-20 11:56 寒假调直立 - 16-03-15速度闭环\build\led_demo\Debug\Obj\arm_cm4.o
文件 8728 2015-08-12 20:35 寒假调直立 - 16-03-15速度闭环\build\led_demo\Debug\Obj\assert.o
文件 37728 2016-03-12 20:56 寒假调直立 - 16-03-15速度闭环\build\led_demo\Debug\Obj\CollectDate.o
文件 35772 2016-03-12 20:56 寒假调直立 - 16-03-15速度闭环\build\led_demo\Debug\Obj\Control.o
............此处省略298个文件信息
相关资源
- 飞思卡尔智能车技术报告
- 飞思卡尔智能车电磁采样装置PCB图
- 三种关于飞思卡尔智能车的测速程序
- 基于stm8智能车载空气净化器的完整设
- 智能车PID+算法实现原理讲解
- Plastid智能车仿真程序
- 模糊pid和模糊控制的智能车编程实现
- 飞思卡尔第十届智能车比赛摄像头组
- 十二届恩智浦智能车山东省第十
- 智能车载空气净化器的完整设计
- 2020全国大学生智能车竞赛比赛细则正
- 智能车完整代码
- ps2手柄控制智能车
- 恩智浦13届智能车比赛电磁直立组程序
- 智能车技术报告.docx
- 第十二届智能车节能组国赛前五技术
- 飞思卡尔智能车硬件pcb
- 飞思卡尔智能车程序
- 直立行车参考设计方案
- 智能家居智能插座+智能密码锁+智能车
- 恩智浦智能车资料
- 双电机驱动btn 飞思卡尔智能车
- 基于动力学模型的智能车辆横、纵向
- 上海交大的飞思卡尔智能车模型介绍
- 专业智能车上位机调试软件体验版
- 智能车 北京科技大学光电一队技术报
- 智能车电磁4轮参考程序
- 智能车MT9V034摄像头调试上位机
- 简易智能车\\智能小车的避障及路径规
- 智能车PID算法资料包
评论
共有 条评论