- #include <hidef.h> /* common defines and macros */
- #include "derivative.h" /* derivative-specific definitions */
- #define WHO_AM_I 0x0F
- #define CTRL_REG1 0x20
- #define CTRL_REG2 0x21
- #define CTRL_REG3 0x22
- #define CTRL_REG4 0x23
- #define CTRL_REG5 0x24
- #define OUT_X_L 0x28
- #define OUT_X_H 0x29
- #define OUT_Y_L 0x2A
- #define OUT_Y_H 0x2B
- #define OUT_Z_L 0x2C
- #define OUT_Z_H 0x2D
- #define SlaveAddress 0xD2
- //定義器件在IIC總線中的從地址,根據(jù)ALT ADDRESS地址引腳不同修改
- #define SCL PTM_PTM2
- #define SDA PTM_PTM5
- #define SCL_dir DDRM_DDRM2
- #define SDA_dir DDRM_DDRM5
- #define BUS_CLOCK 48000000 //總線頻率
- #define OSC_CLOCK 16000000 //晶振頻率
- #define somenop(); asm("nop"); asm("nop");/*asm("nop");asm("nop");asm("nop");asm("nop");asm("nop");asm("nop");asm("nop");asm("nop");*/\
- //asm("nop");asm("nop");asm("nop");asm("nop");asm("nop");asm("nop");asm("nop");asm("nop");asm("nop");asm("nop");\
- //asm("nop");asm("nop");asm("nop");asm("nop");asm("nop");asm("nop");asm("nop");asm("nop");asm("nop");asm("nop");\
- //asm("nop");asm("nop");asm("nop");asm("nop");asm("nop");asm("nop");asm("nop");asm("nop");asm("nop");asm("nop");
- //asm("nop");晶振頻率的倒數(shù)
- char BUF[8]; //接收數(shù)據(jù)緩存區(qū)
- uchar ge,shi,bai,qian,wan; //顯示變量
- int dis_data1,dis_data2,dis_data3;//變量
- uchar TxBuf[10] = {0,0,0,0,0,0,0,0,0,0};
- /*************************************************************/
- /* 初始化鎖相環(huán) */
- /*************************************************************/
- void INIT_PLL(void)
- {
- CLKSEL &= 0x7f; //set OSCCLK as sysclk
- PLLCTL &= 0x8F; //Disable PLL circuit
- CRGINT &= 0xDF;
-
- #if(BUS_CLOCK == 48000000)
- SYNR = 0x45;
- #elif(BUS_CLOCK == 40000000)
- SYNR = 0x44;
- #elif(BUS_CLOCK == 32000000)
- SYNR = 0x43;
- #elif(BUS_CLOCK == 24000000)
- SYNR = 0x42;
- #endif
- REFDV = 0x81; //PLLCLK=2×OSCCLK×(SYNR+1)/(REFDV+1)=64MHz ,fbus=32M
- PLLCTL =PLLCTL|0x70; //Enable PLL circuit
- asm NOP;
- asm NOP;
- while(!(CRGFLG&0x08)); //PLLCLK is Locked already
- CLKSEL |= 0x80; //set PLLCLK as sysclk
- }
- /*************************************************************/
- /* 延時(shí)函數(shù) */
- /*************************************************************/
- void delay(void)
- {
- unsigned int i;
- for(i=0;i<5000;i++);
- }
- /*************************************************************/
- /* 初始化IIC */
- /*************************************************************/
- void INIT_IIC(void)
- {
- SCL_dir = 1;
- SCL_dir = 1;
- SCL = 1;
- SDA = 1;
- }
- /*************************************************************/
- /* 啟動(dòng)IIC */
- /*************************************************************/
- void I2Cstart(void)
- {
- SCL_dir = 1;
- SDA_dir = 1;
- SDA = 1;
- somenop();
- SCL = 1;
- somenop();
- somenop();
- SDA = 0;
- somenop();
- somenop();
- SCL = 0;
- }
- /**************************************
- 接收應(yīng)答信號(hào)
- **************************************/
- void L3G4200D_RecvACK()
- {
- SCL_dir = 1;
- SDA_dir = 0;
-
- SCL = 1; //拉高時(shí)鐘線
- somenop();
- somenop(); //延時(shí)
- while(SDA==1);
- SCL = 0; //拉低時(shí)鐘線
- somenop();
- somenop(); //延時(shí)
- }
- /*************************************************************/
- /* IIC發(fā)送數(shù)據(jù) */
- /*************************************************************/
- void I2Csend(byte data)
- {
- unsigned char i=8;
-
- SCL_dir = 1;
- SDA_dir = 1;
-
- for (i=0; i<8; i++) //8位計(jì)數(shù)器
- {
- SDA = (data&0x80)>>7; //送數(shù)據(jù)口
- data=data<<1;
- SCL = 1; //拉高時(shí)鐘線
- somenop();
- somenop(); //延時(shí)
- SCL = 0; //拉低時(shí)鐘線
- somenop();
- somenop(); //延時(shí)
- }
-
- L3G4200D_RecvACK();
- }
- /*************************************************************/
- /* IIC接收數(shù)據(jù) */
- /*************************************************************/
- signed char I2Creceive(void)
- {
- byte i;
- byte dat = 0;
-
- SCL_dir = 1;
- SDA_dir = 0;
- for (i=0; i<8; i++) //8位計(jì)數(shù)器
- {
- dat <<= 1; //這里的1是 00000001
- SCL = 1; //拉高時(shí)鐘線
- somenop();
- somenop(); //延時(shí)
- dat |= SDA; //讀數(shù)據(jù) SDA 00000000 or 00000001
- SCL = 0; //拉低時(shí)鐘線
- somenop();
- somenop(); //延時(shí)
- }
- return dat;
- }
- /**************************************
- 發(fā)送應(yīng)答信號(hào)
- 入口參數(shù):ack (0:ACK 1:NAK)
- **************************************/
- void I2Csendack(char ack)
- {
- SCL_dir = 1;
- SDA_dir = 1;
- if(ack==1)
- {
- SDA = 1; //寫應(yīng)答信號(hào)
- SCL = 1; //拉高時(shí)鐘線
- somenop();
- somenop();
- SCL = 0; //拉低時(shí)鐘線
- somenop();
- somenop();
- }
- else
- {
- SDA = 0; //寫應(yīng)答信號(hào)
- SCL = 1; //拉高時(shí)鐘線
- somenop();
- somenop();
- SCL = 0; //拉低時(shí)鐘線
- somenop();
- somenop();
- }
- }
- /*************************************************************/
- /* 停止IIC */
- /*************************************************************/
- void I2Cstop(void)
- {
- SCL_dir = 1;
- SDA_dir = 1;
-
- SCL = 1;
- SDA = 0;
- somenop();
- somenop();
- SDA = 1;
- somenop();
- somenop();
- }
- //單字節(jié)寫入*******************************************
- void Single_WriteL3G4200D(uchar REG_Address,uchar REG_data)
- {
- I2Cstart(); //起始信號(hào)
- I2Csend(SlaveAddress); //發(fā)送設(shè)備地址+寫信號(hào)
- I2Csend(REG_Address); //內(nèi)部寄存器地址,請(qǐng)參考中文pdf22頁
- I2Csend(REG_data); //內(nèi)部寄存器數(shù)據(jù),請(qǐng)參考中文pdf22頁
- I2Cstop(); //發(fā)送停止信號(hào)
- }
- //單字節(jié)讀取*****************************************
- uchar Single_ReadL3G4200D(uchar REG_Address)
- {
- uchar REG_data;
- I2Cstart(); //起始信號(hào)
- I2Csend(SlaveAddress); //發(fā)送設(shè)備地址+寫信號(hào)
- I2Csend(REG_Address); //發(fā)送存儲(chǔ)單元地址,從0開始
- I2Cstart(); //起始信號(hào)
- I2Csend(SlaveAddress+1); //發(fā)送設(shè)備地址+讀信號(hào)
- REG_data=I2Creceive(); //讀出寄存器數(shù)據(jù)
- I2Csendack(1);
- I2Cstop(); //停止信號(hào)
- return REG_data;
- }
- //*************************************************
- //*****************************************************************
- //初始化L3G4200D,根據(jù)需要請(qǐng)參考pdf,第27頁,進(jìn)行修改************************
- void InitL3G4200D()
- {
- Single_WriteL3G4200D(CTRL_REG1, 0x0f); // 0x0f=00001111 普通模式 X Y Z 啟用。
- Single_WriteL3G4200D(CTRL_REG2, 0x00); // 選擇高通濾波模式和高通截止頻率 此為普通模式
- Single_WriteL3G4200D(CTRL_REG3, 0x08); // 0x08=0000 1000 DRDY/INT2 數(shù)據(jù)準(zhǔn)備(0: Disable; 1: Enable)默認(rèn)0
- Single_WriteL3G4200D(CTRL_REG4, 0x00 ); // 選擇量程 滿量程選擇(默認(rèn) 00)(00:250dps)
- Single_WriteL3G4200D(CTRL_REG5, 0x00); // 篎FIFO使能,高通濾波使
- }
- void SCI_Init()
- {
- SCI1BD = BUS_CLOCK/16/9600; //設(shè)置SCI1波特率為9600
- SCI1CR1 = 0x00; //設(shè)置SCI1為正常模式,八位數(shù)據(jù)位,無奇偶校驗(yàn)
- SCI1CR2 = 0x0c; //允許發(fā)送和接收數(shù)據(jù),禁止中斷功能*/
- MODRR|=0X80;
-
- }
- void SCI_send(unsigned char data)
- {
- while(!SCI1SR1_TDRE); //等待發(fā)送數(shù)據(jù)寄存器(緩沖器)為空
- SCI1DRL = data;
- }
- /*************************************************************/
- /* 串口發(fā)送字符串函數(shù) */
- /*************************************************************/
- void send_string(unsigned char *putchar)
- {
- while(*putchar!=0x00) //判斷字符串是否發(fā)送完畢
- {
-
- SCI_send(*putchar++);
- }
- }
- uchar SCI_receive()
- {
- uchar a;
- while(!SCI1SR1_RDRF);
- a=SCI1DRL;
- return a;
- }
- void SCI_sendstring(unsigned char *a,unsigned char stringlen)
- {
- unsigned char i;
- for(i=0;i<=stringlen;i++)
- SCI_send(*(a++));
- }
- unsigned int CRC_Check(unsigned char *Buf, unsigned char crc_count)
- {
- unsigned short CRC_Temp;
- unsigned char i,j;
- CRC_Temp = 0xffff;
- for (i=0;i<crc_count; i++)
- {
- CRC_Temp ^= Buf[i];
- for(j=0;j<8;j++)
- {
- if (CRC_Temp & 0x01)
- CRC_Temp = (CRC_Temp >>1 ) ^ 0xa001;
- else
- CRC_Temp = CRC_Temp >> 1;
- }
- }
- return(CRC_Temp);
- }
- void WirelessSerial(int a,int b,int c,int d)
- {
- int num;
- unsigned char *data;
- unsigned char nrf_flag = 0,error;
- int *pdat;
- #if 1
- num = (int)a; //Speed
- data = (unsigned char *)#
- TxBuf[1] = *data;
- data++;
- TxBuf[0] = *data;
-
- num = (int)b; //MotorPWM
- data = (unsigned char *)#
- TxBuf[3] = *data;
- data++;
- TxBuf[2] = *data;
- num = (int)c; //angle
- data = (unsigned char *)#
- TxBuf[5] = *data;
- data++;
- TxBuf[4] = *data;
-
- num = (int)d;
- data = (unsigned char *)#
- TxBuf[7] = *data;
- data++;
- TxBuf[6] = *data;
- #endif
- num = CRC_Check(TxBuf,8);
- TxBuf[8] = num & 0xFF;
- TxBuf[9] = num >> 8;
- SCI_sendstring(TxBuf,9);
- }
- void main(void)
- {
- DisableInterrupts;
-
- INIT_PLL();
-
- INIT_IIC();
-
- SCI_Init();
-
- InitL3G4200D();
-
- EnableInterrupts;
- for(;;)
- {
-
- BUF[0]= Single_ReadL3G4200D(OUT_X_L);
- BUF[1]= Single_ReadL3G4200D(OUT_X_H);
- dis_data1=(BUF[1]<<8)+BUF[0];
-
-
- BUF[2]= Single_ReadL3G4200D(OUT_Y_L);
- BUF[3]= Single_ReadL3G4200D(OUT_Y_H);
- dis_data2=(BUF[3]<<8)+BUF[2];
-
-
- BUF[4]= Single_ReadL3G4200D(OUT_Z_L);
- BUF[5]= Single_ReadL3G4200D(OUT_Z_H);
- dis_data3=(BUF[5]<<8)+BUF[4];
-
-
- WirelessSerial(dis_data1,0,0,0);
-
-
-
-
-
- }
- }
復(fù)制代碼
MMA7451的例程,你只需要找到PN532的相關(guān)地址改下就ok了 |