注册会员
- 积分
- 117
- 威望
- 75
- 贡献
- 26
- 兑换币
- 30
- 注册时间
- 2015-6-8
- 在线时间
- 8 小时
- 毕业学校
- 烟台职业学院
|
我的小车不检测电磁 不知道是不是这段程序除了错 求大神们帮忙看看。
void position()
{
g_f_Position_Mid_Old=g_f_Position_Mid;
g_f_Position_Mid=(AD_value2)/(g_n_AD_Result_Big);
g_f_Position_L =(AD_value1)/(g_n_AD_Result_Big);
g_f_Position_R =(AD_value3)/(g_n_AD_Result_Big);
if(AD_value1>AD_value3)g_f_Position_Mid=1-g_f_Position_Mid;
if(AD_value1<AD_value3)g_f_Position_Mid=g_f_Position_Mid-1;
if(AD_value1==AD_value3)g_f_Position_Mid=0;
if((AD_value4>1400)&&(AD_value5<200))
{
g_f_Position_Mid_flag=0.9;
Direction_n=150;
}
if(AD_value5>1400&&(AD_value4<200))
{
g_f_Position_Mid_flag=-0.9;
Direction_n=150;
}
if(Direction_n>0)
{
Direction_n--;
g_f_Position_Mid=g_f_Position_Mid_flag;
}
if(g_f_Position_L<0.2)g_f_Position_Mid=-0.7;
if(g_f_Position_R<0.2)g_f_Position_Mid=0.7;
}
void Direction()
{
AD_Begin_ave10(); //电感AD读取
Compare(AD_value1,AD_value2,AD_value3,AD_value4,AD_value5); //前排 比较电感大小,用于判断与赛道的偏差
position();
g_f_Direction_S3010=605+g_f_Position_Mid*Direction_P+(g_f_Position_Mid-g_f_Position_Mid_Old)*Direction_D;
if(g_f_Direction_S3010<540)g_f_Direction_S3010=540;
if(g_f_Direction_S3010>670)g_f_Direction_S3010=670;
S3010((int)g_f_Direction_S3010);
}
|
|