added simple block transfer code
This commit is contained in:
parent
0e87c693f4
commit
59bb6ba046
|
@ -106,6 +106,7 @@
|
||||||
|
|
||||||
/* exported functions */
|
/* exported functions */
|
||||||
int nrf_rcv_pkt_time(int maxtime, int maxsize, uint8_t * pkt);
|
int nrf_rcv_pkt_time(int maxtime, int maxsize, uint8_t * pkt);
|
||||||
|
char nrf_snd_pkt_crc(int size, uint8_t * pkt);
|
||||||
void nrf_init() ;
|
void nrf_init() ;
|
||||||
|
|
||||||
void nrf_cmd(uint8_t cmd);
|
void nrf_cmd(uint8_t cmd);
|
||||||
|
|
|
@ -0,0 +1,93 @@
|
||||||
|
#include "rftransfer.h"
|
||||||
|
#include "nrf24l01p.h"
|
||||||
|
#include <basic/basic.h>
|
||||||
|
#include <core/systick/systick.h>
|
||||||
|
|
||||||
|
void rftransfer_send(uint16_t size, uint8_t *data)
|
||||||
|
{
|
||||||
|
uint8_t buf[30];
|
||||||
|
buf[0] = 'L';
|
||||||
|
buf[1] = size >> 8;
|
||||||
|
buf[2] = size & 0xFF;
|
||||||
|
|
||||||
|
uint16_t rand = 5; //random_rand16();
|
||||||
|
buf[3] = rand >> 8;
|
||||||
|
buf[4] = rand & 0xFF;
|
||||||
|
|
||||||
|
nrf_snd_pkt_crc(5,buf); //setup packet
|
||||||
|
|
||||||
|
uint16_t index = 0;
|
||||||
|
uint8_t i;
|
||||||
|
while(size){
|
||||||
|
buf[0] = 'D';
|
||||||
|
buf[1] = index >> 8;
|
||||||
|
buf[2] = index & 0xFF;
|
||||||
|
buf[3] = rand >> 8;
|
||||||
|
buf[4] = rand & 0xFF;
|
||||||
|
for(i=5; i<30 && size>0; i++,size--){
|
||||||
|
buf[i] = *data++;
|
||||||
|
}
|
||||||
|
index++;
|
||||||
|
nrf_snd_pkt_crc(i,buf); //data packet
|
||||||
|
}
|
||||||
|
|
||||||
|
uint16_t crc = crc16(data,size);
|
||||||
|
buf[0] = 'C';
|
||||||
|
buf[1] = crc >> 8;
|
||||||
|
buf[2] = crc & 0xFF;
|
||||||
|
buf[3] = rand >> 8;
|
||||||
|
buf[4] = rand & 0xFF;
|
||||||
|
nrf_snd_pkt_crc(5,buf); //crc packet
|
||||||
|
}
|
||||||
|
|
||||||
|
uint16_t rftransfer_receive(uint8_t *buffer, uint16_t maxlen, uint16_t timeout)
|
||||||
|
{
|
||||||
|
uint8_t buf[30];
|
||||||
|
uint8_t state = 0;
|
||||||
|
uint16_t pos = 0, seq = 0, size = 0, rand = 0, crc = 0;
|
||||||
|
int n,i;
|
||||||
|
unsigned int currentTick = systickGetTicks();
|
||||||
|
unsigned int startTick = currentTick;
|
||||||
|
|
||||||
|
while(currentTick < (startTick+timeout) ){//this fails if either overflows
|
||||||
|
n = nrf_rcv_pkt_time(10, 30, buf);
|
||||||
|
switch(state){
|
||||||
|
case 0:
|
||||||
|
if( n == 5 && buf[0] == 'L' ){
|
||||||
|
size = (buf[1] << 8) | buf[2];
|
||||||
|
rand = (buf[3] << 8) | buf[4];
|
||||||
|
seq = 0;
|
||||||
|
pos = 0;
|
||||||
|
if( size <= maxlen )
|
||||||
|
state = 1;
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
case 1:
|
||||||
|
if( n > 5 && buf[0] == 'D' && ((buf[3]<<8)|buf[4])==rand ){
|
||||||
|
if( seq == ((buf[1]<<8)|buf[2]) ){
|
||||||
|
if( (pos + n - 5)<maxlen ){
|
||||||
|
for(i=5; i<n; i++,pos++){
|
||||||
|
buffer[pos] = buf[i];
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
if( pos == size ){
|
||||||
|
crc = crc16(buffer, size);
|
||||||
|
state = 2;
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
case 2:
|
||||||
|
if( n == 5 && buf[0] == 'C' && ((buf[3]<<8)|buf[4])==rand){
|
||||||
|
if( crc == ((buf[1]<<8)|buf[2]) ){
|
||||||
|
return size;
|
||||||
|
}else{
|
||||||
|
state = 0;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
};
|
||||||
|
}
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
|
@ -0,0 +1,9 @@
|
||||||
|
#ifndef _RFTRANSFER_H
|
||||||
|
#define _RFTRANSFER_H
|
||||||
|
#include <stdint.h>
|
||||||
|
|
||||||
|
void rftransfer_send(uint16_t size, uint8_t *data);
|
||||||
|
uint16_t rftransfer_receive(uint8_t *buffer, uint16_t maxlen, uint16_t timeout);
|
||||||
|
|
||||||
|
|
||||||
|
#endif
|
Loading…
Reference in New Issue