文档下载 文档下载导航
设为首页 | 加入收藏
搜索 请输入内容:  
 导航当前位置: 文档下载 > 所有分类 > 工程科技 > 信息与通信 > 飞思卡尔智能车电磁组 程序
侵权投诉

飞思卡尔智能车电磁组 程序

第六届飞思卡尔智能车华北赛区程序

#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页

你可能喜欢

  • 电磁设计
  • 飞思卡尔电磁组程序
  • 飞思卡尔智能车光电组
  • 飞思卡尔技术报告
  • 陀螺仪原理

热门文档

相关文档

站点地图 | 文档上传 | 侵权投诉 | 手机版
本站所有资源均来自互联网,本站只负责收集和整理,均不承担任何法律责任,如有侵权等其它行为请联系我们.
文档下载 Copyright 2013 doc.guandang.net All Rights Reserved.  -  email