deac/osd-contiki
1
0
Fork 0
Code Issues Pull requests Releases Wiki Activity

Cleaned up and re-formatted source of linuxradiodrv

Browse source
This commit is contained in:
Vladimir Pouzanov 2014-01-25 17:16:54 +00:00 committed by Vladimir Pouzanov
parent 113d9761f7
commit 43a327df5a
1 changed files with 29 additions and 40 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

69
cpu/native/net/linuxradio-drv.c
View file

@ -67,16 +67,15 @@ static int
init(void) init(void)
{ {
sockbuf = malloc(MAX_PACKET_SIZE); sockbuf = malloc(MAX_PACKET_SIZE);
if (sockbuf == 0) { if(sockbuf == 0) {
return 1; return 1;
} }
return 0; return 0;
} }
static int static int
prepare(const void *payload, unsigned short payload_len) prepare(const void *payload, unsigned short payload_len)
{ {
if (payload_len > MAX_PACKET_SIZE) { if(payload_len > MAX_PACKET_SIZE) {
return 0; return 0;
} }
memcpy(sockbuf, payload, payload_len); memcpy(sockbuf, payload, payload_len);
@ -84,26 +83,24 @@ prepare(const void *payload, unsigned short payload_len)
return 0; return 0;
} }
static int static int
transmit(unsigned short transmit_len) transmit(unsigned short transmit_len)
{ {
int sent=0; int sent = 0;
sent = send(sockfd, sockbuf, buflen, 0); sent = send(sockfd, sockbuf, buflen, 0);
if (sent < 0) { if(sent < 0) {
perror("linuxradio send()"); perror("linuxradio send()");
return RADIO_TX_ERR; return RADIO_TX_ERR;
} }
buflen = 0; buflen = 0;
return RADIO_TX_OK; return RADIO_TX_OK;
} }
static int static int
my_send(const void *payload, unsigned short payload_len) my_send(const void *payload, unsigned short payload_len)
{ {
int ret = -1; int ret = -1;
if (prepare(payload, payload_len)) { if(prepare(payload, payload_len)) {
return ret; return ret;
} }
@ -111,42 +108,36 @@ my_send(const void *payload, unsigned short payload_len)
return ret; return ret;
} }
static int static int
my_read(void *buf, unsigned short buf_len) my_read(void *buf, unsigned short buf_len)
{ {
return 0; return 0;
} }
static int static int
channel_clear(void) channel_clear(void)
{ {
return 1; return 1;
} }
static int static int
receiving_packet(void) receiving_packet(void)
{ {
return 0; return 0;
} }
static int static int
pending_packet(void) pending_packet(void)
{ {
return 0; return 0;
} }
static int static int
set_fd(fd_set *rset, fd_set *wset) set_fd(fd_set *rset, fd_set *wset)
{ {
FD_SET(sockfd, rset); FD_SET(sockfd, rset);
return 1; return 1;
} }
static void static void
handle_fd(fd_set *rset, fd_set *wset) handle_fd(fd_set *rset, fd_set *wset)
{ {
if (FD_ISSET(sockfd, rset)) { if(FD_ISSET(sockfd, rset)) {
int bytes = read(sockfd, sockbuf, MAX_PACKET_SIZE); int bytes = read(sockfd, sockbuf, MAX_PACKET_SIZE);
buflen = bytes; buflen = bytes;
memcpy(packetbuf_dataptr(), sockbuf, bytes); memcpy(packetbuf_dataptr(), sockbuf, bytes);
@ -154,32 +145,32 @@ handle_fd(fd_set *rset, fd_set *wset)
NETSTACK_RDC.input(); NETSTACK_RDC.input();
} }
} }
static const struct select_callback linuxradio_sock_callback = { set_fd, handle_fd }; static const struct select_callback linuxradio_sock_callback = { set_fd, handle_fd };
static int static int
on(void) on(void)
{ {
struct ifreq ifr;
int err;
struct sockaddr_ll sll;
sockfd = socket(PF_PACKET, SOCK_RAW, htons(ETH_P_IEEE802154)); sockfd = socket(PF_PACKET, SOCK_RAW, htons(ETH_P_IEEE802154));
if (sockfd < 0) { if(sockfd < 0) {
perror ("linuxradio socket()"); perror("linuxradio socket()");
return 0; return 0;
} else { } else {
struct ifreq ifr; /* TODO: interface should not be hard-coded */
// TODO: interface should not be hard-coded
strncpy((char *)ifr.ifr_name, "wpan0", IFNAMSIZ); strncpy((char *)ifr.ifr_name, "wpan0", IFNAMSIZ);
int err = ioctl(sockfd, SIOCGIFINDEX, &ifr); err = ioctl(sockfd, SIOCGIFINDEX, &ifr);
if (err == -1) { if(err == -1) {
perror ("linuxradio ioctl()"); perror("linuxradio ioctl()");
return 0; return 0;
} }
struct sockaddr_ll sll;
sll.sll_family = AF_PACKET; sll.sll_family = AF_PACKET;
sll.sll_ifindex = ifr.ifr_ifindex; sll.sll_ifindex = ifr.ifr_ifindex;
sll.sll_protocol = htons(ETH_P_IEEE802154); sll.sll_protocol = htons(ETH_P_IEEE802154);
if (bind(sockfd, (struct sockaddr *)&sll, sizeof(sll)) < 0) { if(bind(sockfd, (struct sockaddr *)&sll, sizeof(sll)) < 0) {
perror("linuxradio bind()"); perror("linuxradio bind()");
return 0; return 0;
} }
@ -188,7 +179,6 @@ on(void)
return 1; return 1;
} }
} }
static int static int
off(void) off(void)
{ {
@ -196,17 +186,16 @@ off(void)
sockfd = -1; sockfd = -1;
return 1; return 1;
} }
const struct radio_driver linuxradio_driver = const struct radio_driver linuxradio_driver =
{ {
init, init,
prepare, prepare,
transmit, transmit,
my_send, my_send,
my_read, my_read,
channel_clear, channel_clear,
receiving_packet, receiving_packet,
pending_packet, pending_packet,
on, on,
off, off,
}; };