- #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總線中的從地址,根據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");晶振頻率的倒數
- char BUF[8]; //接收數據緩存區
- 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};
- /*************************************************************/
- /* 初始化鎖相環 */
- /*************************************************************/
- 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
- }
- /*************************************************************/
- /* 延時函數 */
- /*************************************************************/
- 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;
- }
- /*************************************************************/
- /* 啟動IIC */
- /*************************************************************/
- void I2Cstart(void)
- {
- SCL_dir = 1;
- SDA_dir = 1;
- SDA = 1;
- somenop();
- SCL = 1;
- somenop();
- somenop();
- SDA = 0;
- somenop();
- somenop();
- SCL = 0;
- }
- /**************************************
- 接收應答信號
- **************************************/
- void L3G4200D_RecvACK()
- {
- SCL_dir = 1;
- SDA_dir = 0;
-
- SCL = 1; //拉高時鐘線
- somenop();
- somenop(); //延時
- while(SDA==1);
- SCL = 0; //拉低時鐘線
- somenop();
- somenop(); //延時
- }
- /*************************************************************/
- /* IIC發送數據 */
- /*************************************************************/
- void I2Csend(byte data)
- {
- unsigned char i=8;
-
- SCL_dir = 1;
- SDA_dir = 1;
-
- for (i=0; i<8; i++) //8位計數器
- {
- SDA = (data&0x80)>>7; //送數據口
- data=data<<1;
- SCL = 1; //拉高時鐘線
- somenop();
- somenop(); //延時
- SCL = 0; //拉低時鐘線
- somenop();
- somenop(); //延時
- }
-
- L3G4200D_RecvACK();
- }
- /*************************************************************/
- /* IIC接收數據 */
- /*************************************************************/
- signed char I2Creceive(void)
- {
- byte i;
- byte dat = 0;
-
- SCL_dir = 1;
- SDA_dir = 0;
- for (i=0; i<8; i++) //8位計數器
- {
- dat <<= 1; //這里的1是 00000001
- SCL = 1; //拉高時鐘線
- somenop();
- somenop(); //延時
- dat |= SDA; //讀數據 SDA 00000000 or 00000001
- SCL = 0; //拉低時鐘線
- somenop();
- somenop(); //延時
- }
- return dat;
- }
- /**************************************
- 發送應答信號
- 入口參數:ack (0:ACK 1:NAK)
- **************************************/
- void I2Csendack(char ack)
- {
- SCL_dir = 1;
- SDA_dir = 1;
- if(ack==1)
- {
- SDA = 1; //寫應答信號
- SCL = 1; //拉高時鐘線
- somenop();
- somenop();
- SCL = 0; //拉低時鐘線
- somenop();
- somenop();
- }
- else
- {
- SDA = 0; //寫應答信號
- SCL = 1; //拉高時鐘線
- somenop();
- somenop();
- SCL = 0; //拉低時鐘線
- somenop();
- somenop();
- }
- }
- /*************************************************************/
- /* 停止IIC */
- /*************************************************************/
- void I2Cstop(void)
- {
- SCL_dir = 1;
- SDA_dir = 1;
-
- SCL = 1;
- SDA = 0;
- somenop();
- somenop();
- SDA = 1;
- somenop();
- somenop();
- }
- //單字節寫入*******************************************
- void Single_WriteL3G4200D(uchar REG_Address,uchar REG_data)
- {
- I2Cstart(); //起始信號
- I2Csend(SlaveAddress); //發送設備地址+寫信號
- I2Csend(REG_Address); //內部寄存器地址,請參考中文pdf22頁
- I2Csend(REG_data); //內部寄存器數據,請參考中文pdf22頁
- I2Cstop(); //發送停止信號
- }
- //單字節讀取*****************************************
- uchar Single_ReadL3G4200D(uchar REG_Address)
- {
- uchar REG_data;
- I2Cstart(); //起始信號
- I2Csend(SlaveAddress); //發送設備地址+寫信號
- I2Csend(REG_Address); //發送存儲單元地址,從0開始
- I2Cstart(); //起始信號
- I2Csend(SlaveAddress+1); //發送設備地址+讀信號
- REG_data=I2Creceive(); //讀出寄存器數據
- I2Csendack(1);
- I2Cstop(); //停止信號
- return REG_data;
- }
- //*************************************************
- //*****************************************************************
- //初始化L3G4200D,根據需要請參考pdf,第27頁,進行修改************************
- 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 數據準備(0: Disable; 1: Enable)默認0
- Single_WriteL3G4200D(CTRL_REG4, 0x00 ); // 選擇量程 滿量程選擇(默認 00)(00:250dps)
- Single_WriteL3G4200D(CTRL_REG5, 0x00); // 篎FIFO使能,高通濾波使
- }
- void SCI_Init()
- {
- SCI1BD = BUS_CLOCK/16/9600; //設置SCI1波特率為9600
- SCI1CR1 = 0x00; //設置SCI1為正常模式,八位數據位,無奇偶校驗
- SCI1CR2 = 0x0c; //允許發送和接收數據,禁止中斷功能*/
- MODRR|=0X80;
-
- }
- void SCI_send(unsigned char data)
- {
- while(!SCI1SR1_TDRE); //等待發送數據寄存器(緩沖器)為空
- SCI1DRL = data;
- }
- /*************************************************************/
- /* 串口發送字符串函數 */
- /*************************************************************/
- void send_string(unsigned char *putchar)
- {
- while(*putchar!=0x00) //判斷字符串是否發送完畢
- {
-
- 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);
-
-
-
-
-
- }
- }
復制代碼
MMA7451的例程,你只需要找到PN532的相關地址改下就ok了 |