Songw Jiang / nRF24L01P

Dependents:   RC_Green Drown RC_RX

Committer:
Ucial
Date:
Sat Dec 14 11:56:11 2019 +0000
Revision:
7:fa987efaeecd
Parent:
6:a0e847d59312
Child:
8:62cdaa369cfa
c

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Ucial 0:4caead137300 1 #include "nRF24L01P.h"
Ucial 0:4caead137300 2
Ucial 1:c41959327807 3
Ucial 0:4caead137300 4 uint8_t NRF24L01_RXDATA[32];
Ucial 0:4caead137300 5 uint8_t NRF24L01_TXDATA[32];
Ucial 5:d0c9b8b5cf75 6 uint8_t TX_ADDRESS[5]= {0x00,0x00,0x00,0x00,0x08};
Ucial 5:d0c9b8b5cf75 7 uint8_t RX_ADDRESS[5]= {0x00,0x00,0x00,0x00,0x08};
Ucial 0:4caead137300 8 int Nrf_Erro=0;
Ucial 0:4caead137300 9 int ledtick;
Ucial 5:d0c9b8b5cf75 10
Ucial 5:d0c9b8b5cf75 11 void nRF24L01P::setTransferSize(int TransSize ){}
Ucial 5:d0c9b8b5cf75 12
Ucial 5:d0c9b8b5cf75 13 void nRF24L01P::setRxAddress(int RxAdd)
Ucial 5:d0c9b8b5cf75 14 {
Ucial 5:d0c9b8b5cf75 15 RX_ADDRESS[4]=RxAdd&0xFF;
Ucial 5:d0c9b8b5cf75 16 }
Ucial 5:d0c9b8b5cf75 17 void nRF24L01P::setTxAddress(int TxAdd)
Ucial 5:d0c9b8b5cf75 18 {
Ucial 5:d0c9b8b5cf75 19 TX_ADDRESS[4]=TxAdd&0xFF;
Ucial 5:d0c9b8b5cf75 20 }
Ucial 0:4caead137300 21
Ucial 0:4caead137300 22 uint8_t nRF24L01P::NRF_Read_Reg(uint8_t reg)
Ucial 0:4caead137300 23 {
Ucial 0:4caead137300 24 uint8_t reg_val;
Ucial 0:4caead137300 25 nCS_=0;
Ucial 0:4caead137300 26 spi_.write(reg);
Ucial 0:4caead137300 27 reg_val = spi_.write(0);
Ucial 0:4caead137300 28 nCS_=1;
Ucial 0:4caead137300 29 return reg_val;
Ucial 0:4caead137300 30
Ucial 0:4caead137300 31 }
Ucial 0:4caead137300 32 uint8_t nRF24L01P::NRF_Write_Reg(uint8_t reg, uint8_t value)
Ucial 0:4caead137300 33 {
Ucial 0:4caead137300 34 uint8_t status;
Ucial 0:4caead137300 35 nCS_=0;
Ucial 0:4caead137300 36 status = spi_.write(reg);
Ucial 0:4caead137300 37 spi_.write(value);
Ucial 0:4caead137300 38 nCS_=1;
Ucial 0:4caead137300 39 return status;
Ucial 0:4caead137300 40 }
Ucial 0:4caead137300 41 uint8_t nRF24L01P::NRF_Read_Buff(uint8_t reg, uint8_t *pBuf, uint8_t uchars)
Ucial 0:4caead137300 42 {
Ucial 0:4caead137300 43 uint8_t i;
Ucial 0:4caead137300 44 uint8_t status;
Ucial 0:4caead137300 45 nCS_=0;
Ucial 0:4caead137300 46 status = spi_.write(reg);
Ucial 0:4caead137300 47 for(i=0; i<uchars; i++)
Ucial 0:4caead137300 48 {
Ucial 0:4caead137300 49 pBuf[i] = spi_.write(0);
Ucial 0:4caead137300 50 }
Ucial 0:4caead137300 51 nCS_=1;
Ucial 0:4caead137300 52 return status;
Ucial 0:4caead137300 53 }
Ucial 0:4caead137300 54 uint8_t nRF24L01P::NRF_Write_Buf(uint8_t reg, uint8_t *pBuf, uint8_t uchars)
Ucial 0:4caead137300 55 {
Ucial 0:4caead137300 56 uint8_t i;
Ucial 0:4caead137300 57 uint8_t status;
Ucial 0:4caead137300 58 nCS_=0;
Ucial 0:4caead137300 59 status = spi_.write(reg);
Ucial 0:4caead137300 60 for(i=0; i<uchars; i++)
Ucial 0:4caead137300 61 {
Ucial 0:4caead137300 62 spi_.write(pBuf[i]);
Ucial 0:4caead137300 63 }
Ucial 0:4caead137300 64 nCS_=1;
Ucial 0:4caead137300 65 return status;
Ucial 0:4caead137300 66 }
Ucial 0:4caead137300 67 void nRF24L01P::NRF24L01_Set_TX(void)
Ucial 0:4caead137300 68 {
Ucial 0:4caead137300 69 ce_=0;
Ucial 0:4caead137300 70 nRF24L01P::NRF_Write_Reg(NRF_WRITE_REG + CONFIG,0x0E);
Ucial 0:4caead137300 71 ce_=1;
Ucial 0:4caead137300 72 }
Ucial 0:4caead137300 73 void nRF24L01P::NRF24L01_Set_RX(void)
Ucial 0:4caead137300 74 {
Ucial 0:4caead137300 75 ce_=0;
Ucial 0:4caead137300 76 NRF_Write_Reg(NRF_WRITE_REG + CONFIG,0x0F);//½ÓÊÕ
Ucial 0:4caead137300 77 ce_=1;
Ucial 0:4caead137300 78 }
Ucial 0:4caead137300 79 void nRF24L01P::NRF_Send_TX(uint8_t * tx_buf, uint8_t len)
Ucial 0:4caead137300 80 {
Ucial 0:4caead137300 81 nRF24L01P::NRF24L01_Set_TX();
Ucial 0:4caead137300 82 ce_=0;
Ucial 0:4caead137300 83 nRF24L01P::NRF_Write_Buf(WR_TX_PLOAD, tx_buf, len);
Ucial 0:4caead137300 84 ce_=1;
Ucial 0:4caead137300 85 wait_us(10);
Ucial 0:4caead137300 86 ledtick++;
Ucial 0:4caead137300 87 if(ledtick>=50)
Ucial 0:4caead137300 88 {
Ucial 0:4caead137300 89 check_led=!check_led;
Ucial 0:4caead137300 90 ledtick=0;
Ucial 0:4caead137300 91 }
Ucial 0:4caead137300 92 }
Ucial 2:bee3d3ba881f 93 void nRF24L01P::NRF_Send_TX(int * tx_buf, uint8_t len)
Ucial 2:bee3d3ba881f 94 {
Ucial 2:bee3d3ba881f 95 uint8_t i;
Ucial 2:bee3d3ba881f 96 uint8_t tx_buff[32];
Ucial 2:bee3d3ba881f 97 for(i=0;i<len;i++)
Ucial 2:bee3d3ba881f 98 tx_buff[i]=tx_buf[i]&0xFF;
Ucial 2:bee3d3ba881f 99 nRF24L01P::NRF24L01_Set_TX();
Ucial 2:bee3d3ba881f 100 ce_=0;
Ucial 4:756125f83a27 101 nRF24L01P::NRF_Write_Buf(WR_TX_PLOAD, tx_buff, len);
Ucial 2:bee3d3ba881f 102 ce_=1;
Ucial 2:bee3d3ba881f 103 wait_us(10);
Ucial 2:bee3d3ba881f 104 ledtick++;
Ucial 2:bee3d3ba881f 105 if(ledtick>=50)
Ucial 2:bee3d3ba881f 106 {
Ucial 2:bee3d3ba881f 107 check_led=!check_led;
Ucial 2:bee3d3ba881f 108 ledtick=0;
Ucial 2:bee3d3ba881f 109 }
Ucial 2:bee3d3ba881f 110 }
Ucial 0:4caead137300 111 nRF24L01P::nRF24L01P(PinName mosi,
Ucial 0:4caead137300 112 PinName miso,
Ucial 0:4caead137300 113 PinName sck,
Ucial 0:4caead137300 114 PinName csn,
Ucial 0:4caead137300 115 PinName ce,
Ucial 0:4caead137300 116 PinName irq):spi_(mosi,miso,sck),nCS_(csn),ce_(ce),nIRQ_(irq),check_led(PC_13)
Ucial 0:4caead137300 117 {
Ucial 0:4caead137300 118 nCS_ = 1;
Ucial 0:4caead137300 119
Ucial 0:4caead137300 120 spi_.frequency(9000000);
Ucial 0:4caead137300 121 spi_.format(8,0);
Ucial 0:4caead137300 122 wait_us(4); // Wait for Power-on reset
Ucial 0:4caead137300 123 }
Ucial 0:4caead137300 124
Ucial 0:4caead137300 125
Ucial 0:4caead137300 126 void nRF24L01P::NRF24L01_Check(void)
Ucial 0:4caead137300 127 {
Ucial 0:4caead137300 128 uint8_t buf[5];
Ucial 0:4caead137300 129 uint8_t i;
Ucial 0:4caead137300 130 NRF_Write_Buf(NRF_WRITE_REG+TX_ADDR,TX_ADDRESS,5);
Ucial 0:4caead137300 131 NRF_Read_Buff(TX_ADDR,buf,5);
Ucial 0:4caead137300 132 for(i=0;i<5;i++)
Ucial 0:4caead137300 133 {
Ucial 0:4caead137300 134 if(buf[i]!=TX_ADDRESS[i])
Ucial 0:4caead137300 135 break;
Ucial 0:4caead137300 136 }
Ucial 0:4caead137300 137
Ucial 0:4caead137300 138 if(i==5)
Ucial 0:4caead137300 139 {
Ucial 0:4caead137300 140 uint8_t ledt;
Ucial 0:4caead137300 141 for(ledt=0;ledt<5;ledt++)
Ucial 0:4caead137300 142 {
Ucial 0:4caead137300 143 check_led=0;
Ucial 0:4caead137300 144 wait_ms(100);
Ucial 0:4caead137300 145 check_led=1;
Ucial 0:4caead137300 146 wait_ms(100);
Ucial 0:4caead137300 147 }
Ucial 0:4caead137300 148 }
Ucial 0:4caead137300 149 }
Ucial 0:4caead137300 150 void nRF24L01P::NRF24L01_Init(uint8_t Chanal,uint8_t Mode)
Ucial 0:4caead137300 151 {
Ucial 7:fa987efaeecd 152 // init_time++;
Ucial 7:fa987efaeecd 153 // if(init_time>=3)
Ucial 7:fa987efaeecd 154 // return;
Ucial 0:4caead137300 155 ce_=0;
Ucial 0:4caead137300 156 ledtick=0;
Ucial 0:4caead137300 157 NRF_Write_Reg(FLUSH_TX,0xff);
Ucial 0:4caead137300 158 NRF_Write_Reg(FLUSH_RX,0xff);
Ucial 0:4caead137300 159 NRF_Write_Buf(NRF_WRITE_REG + TX_ADDR, TX_ADDRESS,5);
Ucial 0:4caead137300 160 NRF_Write_Buf(NRF_WRITE_REG + RX_ADDR_P0,RX_ADDRESS,5);
Ucial 0:4caead137300 161
Ucial 0:4caead137300 162 NRF_Write_Reg(NRF_WRITE_REG + EN_AA, 0x01);
Ucial 0:4caead137300 163 NRF_Write_Reg(NRF_WRITE_REG + EN_RXADDR, 0x01);
Ucial 0:4caead137300 164 NRF_Write_Reg(NRF_WRITE_REG + SETUP_RETR,0x1a);
Ucial 0:4caead137300 165 NRF_Write_Reg(NRF_WRITE_REG + RF_CH, Chanal);
Ucial 0:4caead137300 166 NRF_Write_Reg(NRF_WRITE_REG + RX_PW_P0, 32);
Ucial 0:4caead137300 167 NRF_Write_Reg(NRF_WRITE_REG + RF_SETUP, 0x0f);
Ucial 0:4caead137300 168
Ucial 0:4caead137300 169 if(Mode==TX)
Ucial 0:4caead137300 170 NRF_Write_Reg(NRF_WRITE_REG + CONFIG,0x0E);
Ucial 0:4caead137300 171 else if(Mode==RX)
Ucial 0:4caead137300 172 NRF_Write_Reg(NRF_WRITE_REG + CONFIG,0x0F);
Ucial 7:fa987efaeecd 173 nIRQ_.mode(PullDown);
Ucial 7:fa987efaeecd 174 nIRQ_.rise(&nRF_Analysis);
Ucial 0:4caead137300 175 ce_=1;
Ucial 0:4caead137300 176 }
Ucial 0:4caead137300 177 void nRF24L01P::NRF24L01_IRQ(void)
Ucial 0:4caead137300 178 {
Ucial 0:4caead137300 179 uint8_t status = NRF_Read_Reg(NRF_READ_REG + NRFRegSTATUS);
Ucial 0:4caead137300 180
Ucial 0:4caead137300 181 if(status & (1<<RX_DR))//½ÓÊÕÖжÏ
Ucial 0:4caead137300 182 {
Ucial 0:4caead137300 183 uint8_t rx_len = NRF_Read_Reg(R_RX_PL_WID);//ÊÕµ½Êý¾Ý³¤¶È
Ucial 0:4caead137300 184 if(rx_len==32)
Ucial 0:4caead137300 185 {
Ucial 0:4caead137300 186 NRF_Read_Buff(RD_RX_PLOAD,NRF24L01_RXDATA,rx_len);//¶ÁÈ¡½ÓÊÕFIFOÊý¾Ý
Ucial 0:4caead137300 187 Nrf_Erro = 0;
Ucial 0:4caead137300 188 }
Ucial 0:4caead137300 189 else
Ucial 0:4caead137300 190 {
Ucial 0:4caead137300 191 NRF_Write_Reg(FLUSH_RX,0xff);//Çå¿Õ½ÓÊÕ»º³åÇø
Ucial 0:4caead137300 192 }
Ucial 0:4caead137300 193 }
Ucial 0:4caead137300 194 if(status & (1<<MAX_RT))//´ïµ½×î¶à´ÎÖØ·¢ÖжÏ
Ucial 0:4caead137300 195 {
Ucial 0:4caead137300 196 if(status & (1<<TX_FULL))//TX FIFO Òç³ö
Ucial 0:4caead137300 197 {
Ucial 0:4caead137300 198 NRF_Write_Reg(FLUSH_TX,0xff);//Çå¿Õ·¢ËÍ»º³åÇø
Ucial 0:4caead137300 199 }
Ucial 0:4caead137300 200 }
Ucial 0:4caead137300 201 // if(status & (1<<TX_DS))//·¢ËÍÍê³É
Ucial 0:4caead137300 202 // {
Ucial 0:4caead137300 203 NRF24L01_Set_RX();//ÉèÖÃNrf2401Ϊ½ÓÊÕģʽ
Ucial 0:4caead137300 204 // }
Ucial 0:4caead137300 205 NRF_Write_Reg(NRF_WRITE_REG + NRFRegSTATUS, status);//Çå³ýÖжϱê־λ
Ucial 0:4caead137300 206 }
Ucial 1:c41959327807 207 void nRF24L01P::Nrf_Connect(void)//500HZ
Ucial 1:c41959327807 208 {
Ucial 1:c41959327807 209 Nrf_Erro++;
Ucial 1:c41959327807 210 if(Nrf_Erro%50==0)
Ucial 1:c41959327807 211 {
Ucial 1:c41959327807 212 NRF24L01_IRQ();
Ucial 1:c41959327807 213 }
Ucial 1:c41959327807 214 if(Nrf_Erro>=500)
Ucial 1:c41959327807 215 {
Ucial 1:c41959327807 216 Nrf_Erro = 1;
Ucial 1:c41959327807 217 }
Ucial 1:c41959327807 218 }