日操干,在线免费一级片,999精品在线

#include <STC15W4K60S4.H>
#include <intrins.h>
#include <NRF24L01.H>
//*********************************************NRF24L01*************************************
#define TX_ADR_WIDTH 5 // 5 uints TX address width
#define RX_ADR_WIDTH 5 // 5 uints RX address width
#define TX_PLOAD_WIDTH 20 // 20 uints TX payload
#define RX_PLOAD_WIDTH 20 // 20 uints TX payload
uint const TX_ADDRESS[TX_ADR_WIDTH]= {0x34,0x43,0x10,0x10,0x01}; //本地地址
uint const RX_ADDRESS[RX_ADR_WIDTH]= {0x34,0x43,0x10,0x10,0x01}; //接收地址
//***************************************NRF24L01寄存器指令*******************************************************
#define READ_REG 0x00 // 讀寄存器指令
#define WRITE_REG 0x20 // 寫寄存器指令
#define RD_RX_PLOAD 0x61 // 讀取接收數據指令
#define WR_TX_PLOAD 0xA0 // 寫待發數據指令
#define FLUSH_TX 0xE1 // 沖洗發送 FIFO指令
#define FLUSH_RX 0xE2 // 沖洗接收 FIFO指令
#define REUSE_TX_PL 0xE3 // 定義重復裝載數據指令
#define NOP 0xFF // 保留
//*************************************SPI(nRF24L01)寄存器地址****************************************************
#define CONFIG2 0x00 // 配置收發狀態，CRC校驗模式以及收發狀態響應方式
#define EN_AA 0x01 // 自動應答功能設置
#define EN_RXADDR 0x02 // 可用信道設置
#define SETUP_AW 0x03 // 收發地址寬度設置
#define SETUP_RETR 0x04 // 自動重發功能設置
#define RF_CH 0x05 // 工作頻率設置
#define RF_SETUP 0x06 // 發射速率、功耗功能設置
#define STATUS 0x07 // 狀態寄存器
#define OBSERVE_TX 0x08 // 發送監測功能
#define CD 0x09 // 地址檢測
#define RX_ADDR_P0 0x0A // 頻道0接收數據地址
#define RX_ADDR_P1 0x0B // 頻道1接收數據地址
#define RX_ADDR_P2 0x0C // 頻道2接收數據地址
#define RX_ADDR_P3 0x0D // 頻道3接收數據地址
#define RX_ADDR_P4 0x0E // 頻道4接收數據地址
#define RX_ADDR_P5 0x0F // 頻道5接收數據地址
#define TX_ADDR 0x10 // 發送地址寄存器
#define RX_PW_P0 0x11 // 接收頻道0接收數據長度
#define RX_PW_P1 0x12 // 接收頻道0接收數據長度
#define RX_PW_P2 0x13 // 接收頻道0接收數據長度
#define RX_PW_P3 0x14 // 接收頻道0接收數據長度
#define RX_PW_P4 0x15 // 接收頻道0接收數據長度
#define RX_PW_P5 0x16 // 接收頻道0接收數據長度
#define FIFO_STATUS 0x17 // FIFO棧入棧出狀態寄存器設置
//*****************************************長延時*****************************************
void Delay(unsigned int s)
{
volatile unsigned int i;
for(i=0; i<s; i++);
for(i=0; i<s; i++);
}
//******************************************************************************************
uint bdata sta; //狀態標志
sbit RX_DR =sta^6;
sbit TX_DS =sta^5;
sbit MAX_RT =sta^4;
sbit TX_FULL =sta^0;
/******************************************************************************************
/*延時函數
/******************************************************************************************/
void inerDelay_us(unsigned char n)
{
for(;n>0;n--);
}
//****************************************************************************************
/*NRF24L01初始化
//***************************************************************************************/
void init_NRF24L01(void)
{
CE=0; // chip enable
CSN=1; // Spi disable
SCK=0; //
SPI_Write_Buf(WRITE_REG + TX_ADDR, TX_ADDRESS, TX_ADR_WIDTH); // 寫本地地址
SPI_Write_Buf(WRITE_REG + RX_ADDR_P0, RX_ADDRESS, RX_ADR_WIDTH); // 寫接收端地址
SPI_RW_Reg(WRITE_REG + EN_AA, 0x01); // 頻道0自動 ACK應答允許
SPI_RW_Reg(WRITE_REG + EN_RXADDR, 0x01); // 允許接收地址只有頻道0，如果需要多頻道可以參考Page21
SPI_RW_Reg(WRITE_REG + RF_CH, 0x6e); // 設置信道工作為2.4GHZ，收發必須一致
SPI_RW_Reg(WRITE_REG + RX_PW_P0, RX_PLOAD_WIDTH); //設置接收數據長度，本次設置為32字節
SPI_RW_Reg(WRITE_REG + RF_SETUP, 0x27); //設置發射速率為1MB/S，發射功率為最大值+7dB，由于有X2401L功放，實際+21dbm輸出
}
/****************************************************************************************************
/*函數：uint SPI_RW(uint uchar)
/*功能：NRF24L01的SPI寫時序
/****************************************************************************************************/
uint SPI_RW(uint uchar)
{
uint bit_ctr;
for(bit_ctr=0;bit_ctr<8;bit_ctr++) // output 8-bit
{
MOSI = (uchar & 0x80); // output 'uchar', MSB to MOSI
uchar = (uchar << 1); // shift next bit into MSB..
SCK = 1; // Set SCK high..
inerDelay_us(12);
uchar |= MISO; // capture current MISO bit
inerDelay_us(12);
SCK = 0; // ..then set SCK low again
}
return(uchar); // return read uchar
}
/****************************************************************************************************
/*函數：uchar SPI_Read(uchar reg)
/*功能：NRF24L01的SPI時序
/****************************************************************************************************/
uchar SPI_Read(uchar reg)
{
uchar reg_val;
CSN = 0; // CSN low, initialize SPI communication...
inerDelay_us(12);
SPI_RW(reg); // Select register to read from..
inerDelay_us(12);
reg_val = SPI_RW(0); // ..then read registervalue
inerDelay_us(12);
CSN = 1; // CSN high, terminate SPI communication
return(reg_val); // return register value
}
/****************************************************************************************************/
/*功能：NRF24L01讀寫寄存器函數
/****************************************************************************************************/
uint SPI_RW_Reg(uchar reg, uchar value)
{
uint status;
CSN = 0; // CSN low, init SPI transaction
status = SPI_RW(reg); // select register
SPI_RW(value); // ..and write value to it..
CSN = 1; // CSN high again
return(status); // return nRF24L01 status uchar
}
/****************************************************************************************************/
/*函數：uint SPI_Read_Buf(uchar reg, uchar *pBuf, uchar uchars)
/*功能: 用于讀數據，reg：為寄存器地址，pBuf：為待讀出數據地址，uchars：讀出數據的個數
/****************************************************************************************************/
uint SPI_Read_Buf(uchar reg, uchar *pBuf, uchar uchars)
{
uint status,uchar_ctr;
CSN = 0; // Set CSN low, init SPI tranaction
status = SPI_RW(reg); // Select register to write to and read status uchar
for(uchar_ctr=0;uchar_ctr<uchars;uchar_ctr++)
pBuf[uchar_ctr] = SPI_RW(0); //
CSN = 1;
return(status); // return nRF24L01 status uchar
}
/*********************************************************************************************************
/*函數：uint SPI_Write_Buf(uchar reg, uchar *pBuf, uchar uchars)
/*功能: 用于寫數據：為寄存器地址，pBuf：為待寫入數據地址，uchars：寫入數據的個數
/*********************************************************************************************************/
uint SPI_Write_Buf(uchar reg, uchar *pBuf, uchar uchars)
{
uint status,uchar_ctr;
CSN = 0; //SPI使能
status = SPI_RW(reg);
for(uchar_ctr=0; uchar_ctr<uchars; uchar_ctr++) //
SPI_RW(*pBuf++);
CSN = 1; //關閉SPI
return(status); //
}
/****************************************************************************************************/
/*函數：void SetRX_Mode(void)
/*功能：數據接收配置
/****************************************************************************************************/
void SetRX_Mode(void)
{
CE=0;
SPI_RW_Reg(WRITE_REG + CONFIG2, 0x0f); // IRQ收發完成中斷響應，16位CRC ，主接收
CE = 1;
}
/******************************************************************************************************/
/*函數：unsigned char nRF24L01_RxPacket(unsigned char* rx_buf)
/*功能：數據讀取后放如rx_buf接收緩沖區中
/******************************************************************************************************/
unsigned char nRF24L01_RxPacket(unsigned char* rx_buf)
{
unsigned char revale=0;
sta=SPI_Read(STATUS); // 讀取狀態寄存其來判斷數據接收狀況
if(RX_DR) // 判斷是否接收到數據
{
CE = 0; //SPI使能
SPI_Read_Buf(RD_RX_PLOAD,rx_buf,TX_PLOAD_WIDTH);// read receive payload from RX_FIFO buffer
revale =1; //讀取數據完成標志
}
SPI_RW_Reg(WRITE_REG+STATUS,sta); //接收到數據后RX_DR,TX_DS,MAX_PT都置高為1，通過寫1來清楚中斷標志
CE=1; //！！！！！！！！！！！！！！！！！！！！！！！！！！！！！
return revale;
}
/***********************************************************************************************************
/*函數：void nRF24L01_TxPacket(unsigned char * tx_buf)
/*功能：發送 tx_buf中數據
/**********************************************************************************************************/
void nRF24L01_TxPacket(unsigned char * tx_buf)
{
SPI_RW_Reg(WRITE_REG+STATUS,0xff);
SPI_RW_Reg(0xE1,0xff);
CE=0;
SPI_Write_Buf(WR_TX_PLOAD, tx_buf, TX_PLOAD_WIDTH);
SPI_RW_Reg(WRITE_REG + CONFIG2, 0x0e);
CE=1;
inerDelay_us(10); //CE高電平大于10us才能進入發射模式
}

復制代碼

#include <STC15W4K60S4.H>
#include <EEPROM.h>
#include <intrins.h>
#include <NRF24L01.H>
#include <MPU6050.H>
#define CMD_IDLE 0
#define CMD_READ 1
#define CMD_PROGRAM 2
#define CMD_ERASE 3
#define ENABLE_IAP 0x80 //if SYSCLK<30MHz
extern int g_x,g_y,g_z; //陀螺儀矯正參數
extern char a_x,a_y; //角度矯正參數
extern double Angle,Angley;
void IapIdle()
{
IAP_CONTR = 0;
IAP_CMD = 0;
IAP_TRIG = 0;
IAP_ADDRH = 0x80;
IAP_ADDRL = 0;
}
unsigned char IapReadByte(unsigned int addr) //讀取1字節
{
unsigned char dat;
IAP_CONTR = ENABLE_IAP;
IAP_CMD = CMD_READ;
IAP_ADDRL = addr;
IAP_ADDRH = addr >> 8;
IAP_TRIG = 0x5a;
IAP_TRIG = 0xa5;
_nop_();
dat = IAP_DATA;
IapIdle();
return dat;
}
void IapProgramByte(unsigned int addr, unsigned char dat) //寫入1字節
{
IAP_CONTR = ENABLE_IAP;
IAP_CMD = CMD_PROGRAM;
IAP_ADDRL = addr;
IAP_ADDRH = addr >> 8;
IAP_DATA = dat;
IAP_TRIG = 0x5a;
IAP_TRIG = 0xa5;
_nop_();
IapIdle();
}
void IapEraseSector(unsigned int addr) //扇區擦除
{
IAP_CONTR = ENABLE_IAP;
IAP_CMD = CMD_ERASE;
IAP_ADDRL = addr;
IAP_ADDRH = addr >> 8;
IAP_TRIG = 0x5a;
IAP_TRIG = 0xa5;
_nop_();
IapIdle();
}
void IAP_Gyro() //陀螺儀校準
{
IapEraseSector(0xE200); //扇區擦除
g_y = GetData(GYRO_YOUT_H); //讀取陀螺儀數據
g_x = GetData(GYRO_XOUT_H);
g_z = GetData(GYRO_ZOUT_H);
IapProgramByte(0xE200,g_y>>8); //寫入數據至EEPROM
IapProgramByte(0xE201,g_y);
IapProgramByte(0xE202,g_x>>8); //陀螺儀數據存放至114扇區
IapProgramByte(0xE203,g_x);
IapProgramByte(0xE204,g_z>>8);
IapProgramByte(0xE205,g_z);
IapProgramByte(0xE206,1);
}
void IAP_Angle()
{
IapEraseSector(0xE400); //加速度計數據存放至115扇區
a_x=(char)Angle;
a_y=(char)Angley;
IapProgramByte(0xE400,1);
IapProgramByte(0xE401,a_x);
IapProgramByte(0xE402,a_y);
}
void IAPRead()
{
unsigned char i;
i=IapReadByte(0xE206);
if(i==1) //判斷數據是否已經更新過，更新過才讀取數據
{
g_y=IapReadByte(0xE200)<<8|IapReadByte(0xE201);
g_x=IapReadByte(0xE202)<<8|IapReadByte(0xE203);
g_z=IapReadByte(0xE204)<<8|IapReadByte(0xE205);
}
i=IapReadByte(0xE400);
if(i==1) //判斷數據是否已經更新過，更新過才讀取數據
{
a_x=IapReadByte(0xE401);
a_y=IapReadByte(0xE402);
}
}

復制代碼

久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费