第六届飞思卡尔智能车华北赛区程序
#include <hidef.h> /* common defines and macros */
#include "derivative.h" /* derivative-specific definitions */
#include<mc9s12xs128.h>
#include<math.h>
#pragma LINK_INFO DERIVATIVE "MC9S12XS128"
#define border 15 //电感采集信号的边界值
#define border_back 160 //背后两个电感的边界值
float caiji_ad[9];//存储七路AD采集量,caiji_ad[0] caiji_ad[8]恒等于零
int a,b,c;
unsigned char table[16]={0x3F,0x06,0x5B,0x4f,0x66,0x6d,0x7d,0x07,0x7f,0x6f,0x77,0x7c,0x58,0x5e,0x79,0x71};
int angle_data,angle_pre; //舵机角度
unsigned int caiji_flag; //采集标志
char out;
char flag_pulse;
char outjudge_flag;
int check_stop;
int upp;
unsigned char cha;
unsigned int position_flag;
float position_q=0,position_qp=0,position_qd=0;
float position_h=0,position_hp=0,position_hd=0;
float position_jian;
float position_jia;
float position;
float position_cha,position_zhong;
float pwm1_p;
float pwm1_diff;
unsigned int jishi_flag;
float diff_q,diff_h;
float Speed_tar,Speed_cur,speed_p;
float pwmtemp,pre_pwmtemp;
float PID_P=200;
float PID_I=300;
float PID_D=0.1;
float error=0;
float error_min=-0.1;
float last_error=0;
float pre_error=0;
float banjing ;
void data_init()
{
unsigned int i;
for(i=1;i<7;i++)
{
caiji_ad[i]=0;
}
position_flag=0;
angle_data=2600;
position=0;
angle_pre=0;
diff_q=0;
diff_h=0;
out=0;
outjudge_flag=0;
pwm1_p=2600;
pwm1_diff=0;
jishi_flag=0;
DDRA=0xff;
DDRB=0x0f;
upp=0;
}
void SET_PLL()
{
CLKSEL=0X00;
PLLCTL=0Xe1;
SYNR=4; //设置总线频率为(SYNR+1)*8MHz
REFDV=1;
PLLCTL=0x60;//怎么设置?
asm NOP; ;//空操作,进行简单的延时,等待锁相环的响应
asm NOP;
asm NOP;
while ((CRGFLG&0x08)==0); //时钟校正同步 无执行语句?
CLKSEL=0x80;//使用PLLCLK oscclk是啥?
}
void initPIT()//定时中断初始化函数 5MS定时中断设置
{
PITCFLMT_PITE=0; //PIT功能关
PITCE_PCE0=1;//定时器通道0使能
PITMUX_PMUX0=0; //通道0
PITMTLD0=200;//200分频,在40MHzBusClock下,为200kHz。即//1/200ms=0.005ms
PITLD0=1000;//16位定时器初值设定。PITTIME*0.005MS =5ms //注意!!!可能影响舵机响应时间
PITINTE_PINTE0=1;//定时器中断通道0中断使能
PITCFLMT_PITE=1;//PIT功能开
}
void AD_Init()
{
ATD0CTL1=0x00; //7:1-外部触发,65:00-8位精度,4:放电,3210:ch
ATD0CTL2=0x40; //AFFC=1,对结果寄存器的访问将自动清除转换完成标志位
ATD0CTL3=0x80; //右对齐无符号,4个ad通道采样, No FIFO, Freeze模式下继续转
ATD0CTL4=0x01; //765:采样时间为4个AD时钟周期,ATDClock=[BusClock*0.5]/[PRS+1]
ATD0CTL5=0x30; //6:0特殊通道禁止,5:1连续转换 ,4:1多通道轮流采样
ATD0DIEN=0x00; //禁止数字输入
}
void IOC_Init()
{
PACT
飞思卡尔智能车电磁组程序员成长之路(未完待续)_电子/电路_工程科技_专业资料。飞思卡尔智能车电磁组程序员成长之路 1. 飞思卡尔智能车小车入门智能汽车电磁组...
智能车电磁组完整程序 18页 2下载券飞思卡尔智能车电磁组第七届可用程序...
飞思卡尔智能车电磁组参考方案-最新版_信息与通信_工程科技_专业资料。飞思...程序调试与参数整定 运行测试 图 1.2 参考设计方案内容 参考设计方案经过了...
第五届飞思卡尔智能车电磁组程序_兵器/核科学_工程科技_专业资料。第五届飞思卡尔智能车电磁组获奖程序 MC9S12XS128 单片机、用前置线圈检测磁感线、用无线蓝牙...
飞思卡尔智能车电磁组第... 15页 1下载券喜欢此文档的还喜欢...[1+1/(TI*s)+TD*s] [电磁]PID 调试步骤为什么 PID 应用如此广泛、又长久...
飞思卡尔智能车 电磁组 技术报告_机械/仪表_工程科技_专业资料。---...程序流程图整个系统由单片机为主控MCU,对模拟和数字传感器信号进行采集处理,并 对输出的...
第八届飞思卡尔智能车电磁组技术报告华德思源队_互联网_IT/计算机_专业资料。...次智能车制作的心得、本智能车的不足和值 得改进的地方; 附录 A:模型车程序...
飞思卡尔智能车电磁组参考方案_电子/电路_工程科技_专业资料 暂无评价0人阅读0次下载举报文档 飞思卡尔智能车电磁组参考方案_电子/电路_工程科技_专业资料。 ...
电磁组飞思卡尔智能车技术报告_调查/报告_表格/模板_实用文档。第七届“飞思...加速度计和陀螺仪采集回来的数据送到单片机中通过卡尔 曼滤波 程序处理得到我们所...
飞思卡尔智能车电磁组车辆设计方案_电子/电路_工程科技_专业资料。第七届全国...程序调试与参数整定 运行测试 图 1.2 参考设计方案内容 参考设计方案经过了...
热门文档