sergiotarxz/nuttx-apps
sergiotarxz/nuttx-apps
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity

energy detection scan now works in real time.

Browse Source
This commit is contained in:
Sebastien Lorquet 2015-08-04 18:08:58 +02:00
parent 45864732c5
commit 0a506f8601
1 changed files with 31 additions and 30 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

61
ieee802154/i8sak/i8sak_main.c
View File

@ -103,29 +103,21 @@ int getcca(int fd, FAR struct ieee802154_cca_s *cca)
return ret; return ret;
} }
uint8_t levels[16];
uint8_t disp[16];
int scan(int fd) int scan(int fd)
{ {
int scan;
int ret = OK; int ret = OK;
uint8_t oldchan, chan, energy; uint8_t chan, energy;
uint8_t levels[16];
/* save original channel */ printf("\n");
ret = ioctl(fd, MAC854IOCGCHAN, (unsigned long)&oldchan);
if (ret)
{
printf("MAC854IOCGCHAN failed\n");
return ret;
}
/* do scan */ /* do scan */
memset(disp,0,16);
printf("Scanning channels ");
memset(levels, 0, 16); while(1)
for(scan=0;scan<256;scan++)
{ {
printf("."); fflush(stdout);
for (chan=0; chan<16; chan++) for (chan=0; chan<16; chan++)
{ {
ret = setchan(fd, chan+11); ret = setchan(fd, chan+11);
@ -134,7 +126,6 @@ int scan(int fd)
printf("Device is not an IEEE 802.15.4 interface!\n"); printf("Device is not an IEEE 802.15.4 interface!\n");
return ret; return ret;
} }
ret = ioctl(fd, MAC854IOCGED, (unsigned long)&energy); ret = ioctl(fd, MAC854IOCGED, (unsigned long)&energy);
if (ret<0) if (ret<0)
{ {
@ -142,24 +133,34 @@ int scan(int fd)
return ret; return ret;
} }
if(energy > levels[chan]) levels[chan] = energy;
}
/* compute max with decay */
for (chan=0; chan<16; chan++)
{
if(levels[chan] > disp[chan])
{ {
levels[chan] = energy; disp[chan] = levels[chan];
}
else
{
if(disp[chan] > 0) disp[chan] -= 1;
} }
} }
}
printf("\n");
for (chan=0;chan < 16; chan++)
{
printf("%2d : [%3d] ",chan+11, levels[chan]);
energy = levels[chan] >> 3;
while(energy-- > 0) printf("#");
printf("\n");
}
/* restore original channel */ for (chan=0;chan < 16; chan++)
{
printf("%2d : [%3d] ",chan+11, disp[chan]);
energy = disp[chan] >> 3;
while(energy-- > 0) printf("#");
printf(" \n");
}
ret = setchan(fd, oldchan); /* move cursor 17 lines up : http://www.tldp.org/HOWTO/Bash-Prompt-HOWTO/x361.html */
printf("\x1B[16A");
}
return ret; return ret;
} }