Songw Jiang / nRF24L01P

Dependents:   RC_Green Drown RC_RX

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