version 1.1.1.1.2.5, 2011/10/13 11:01:37
|
version 1.1.1.1.2.10, 2011/10/14 09:04:04
|
Line 5
|
Line 5
|
* $Author$ |
* $Author$ |
* $Id$ |
* $Id$ |
* |
* |
*************************************************************************/ | ************************************************************************* |
| The ELWIX and AITNET software is distributed under the following |
| terms: |
| |
| All of the documentation and software included in the ELWIX and AITNET |
| Releases is copyrighted by ELWIX - Sofia/Bulgaria <info@elwix.org> |
| |
| Copyright 2004, 2005, 2006, 2007, 2008, 2009, 2010, 2011 |
| by Michael Pounov <misho@elwix.org>. All rights reserved. |
| |
| Redistribution and use in source and binary forms, with or without |
| modification, are permitted provided that the following conditions |
| are met: |
| 1. Redistributions of source code must retain the above copyright |
| notice, this list of conditions and the following disclaimer. |
| 2. Redistributions in binary form must reproduce the above copyright |
| notice, this list of conditions and the following disclaimer in the |
| documentation and/or other materials provided with the distribution. |
| 3. All advertising materials mentioning features or use of this software |
| must display the following acknowledgement: |
| This product includes software developed by Michael Pounov <misho@elwix.org> |
| ELWIX - Embedded LightWeight unIX and its contributors. |
| 4. Neither the name of AITNET nor the names of its contributors |
| may be used to endorse or promote products derived from this software |
| without specific prior written permission. |
| |
| THIS SOFTWARE IS PROVIDED BY AITNET AND CONTRIBUTORS ``AS IS'' AND |
| ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE |
| IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE |
| ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE |
| FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL |
| DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS |
| OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) |
| HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT |
| LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY |
| OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF |
| SUCH DAMAGE. |
| */ |
#include "global.h" |
#include "global.h" |
|
|
|
|
Line 60 PrepareL2(const char *psDev, int *bpflen)
|
Line 97 PrepareL2(const char *psDev, int *bpflen)
|
close(h); |
close(h); |
return -1; |
return -1; |
} |
} |
|
n = USHRT_MAX + 1; |
|
if (ioctl(h, BIOCSBLEN, &n) == -1) { |
|
printf("Error:: set buffer interface %s buffer length #%d - %s\n", psDev, errno, strerror(errno)); |
|
close(h); |
|
return -1; |
|
} |
strlcpy(ifr.ifr_name, psDev, sizeof ifr.ifr_name); |
strlcpy(ifr.ifr_name, psDev, sizeof ifr.ifr_name); |
if (ioctl(h, BIOCSETIF, &ifr) == -1) { |
if (ioctl(h, BIOCSETIF, &ifr) == -1) { |
printf("Error:: bind interface %s to bpf #%d - %s\n", psDev, errno, strerror(errno)); |
printf("Error:: bind interface %s to bpf #%d - %s\n", psDev, errno, strerror(errno)); |
Line 72 PrepareL2(const char *psDev, int *bpflen)
|
Line 115 PrepareL2(const char *psDev, int *bpflen)
|
return -1; |
return -1; |
} |
} |
if (ioctl(h, BIOCGBLEN, bpflen) == -1) { |
if (ioctl(h, BIOCGBLEN, bpflen) == -1) { |
printf("Error:: get interface %s buffer length #%d - %s\n", psDev, errno, strerror(errno)); | printf("Error:: get buffer interface %s buffer length #%d - %s\n", psDev, errno, strerror(errno)); |
close(h); |
close(h); |
return -1; |
return -1; |
} |
} |
Line 121 PrepareL3(const struct sockaddr *sa, int *bpflen)
|
Line 164 PrepareL3(const struct sockaddr *sa, int *bpflen)
|
} |
} |
|
|
char |
char |
icmpRecv(int s, u_short * __restrict id, u_int * __restrict crypted, u_char * __restrict data, | icmpRecv(int s, u_int * __restrict seq, u_short * __restrict id, u_int * __restrict crypted, |
int * __restrict datlen, struct sockaddr *sa, socklen_t *salen) | u_char * __restrict data, int * __restrict datlen, struct sockaddr *sa, socklen_t *salen) |
{ |
{ |
int ret = 0; |
int ret = 0; |
struct icmp *icmp; |
struct icmp *icmp; |
Line 185 icmpRecv(int s, u_short * __restrict id, u_int * __res
|
Line 228 icmpRecv(int s, u_short * __restrict id, u_int * __res
|
memcpy(data, buf + sizeof(struct ip) + sizeof(struct icmp) + sizeof(struct ansh_hdr), *datlen); |
memcpy(data, buf + sizeof(struct ip) + sizeof(struct icmp) + sizeof(struct ansh_hdr), *datlen); |
} |
} |
|
|
|
if (seq) |
|
*seq = ntohl(hdr->ansh_seq); |
if (id) |
if (id) |
*id = ntohs(icmp->icmp_id); |
*id = ntohs(icmp->icmp_id); |
return hdr->ansh_flg; |
return hdr->ansh_flg; |
} |
} |
|
|
int |
int |
icmpSend(int s, u_short id, char flg, u_int crypted, u_char *data, int datlen, struct sockaddr *sa, socklen_t salen) | icmpSend(int s, u_int seq, u_short id, char flg, u_int crypted, u_char *data, int datlen, |
| struct sockaddr *sa, socklen_t salen) |
{ |
{ |
u_char *pos, buf[USHRT_MAX] = { 0 }; |
u_char *pos, buf[USHRT_MAX] = { 0 }; |
struct icmp *icmp; |
struct icmp *icmp; |
Line 212 icmpSend(int s, u_short id, char flg, u_int crypted, u
|
Line 258 icmpSend(int s, u_short id, char flg, u_int crypted, u
|
hdr->ansh_flg = flg; |
hdr->ansh_flg = flg; |
hdr->ansh_len = htons(datlen + sizeof(struct ansh_hdr)); |
hdr->ansh_len = htons(datlen + sizeof(struct ansh_hdr)); |
hdr->ansh_nonce = htonl(crypted); |
hdr->ansh_nonce = htonl(crypted); |
|
hdr->ansh_seq = htonl(seq); |
hdr->ansh_crc = 0; |
hdr->ansh_crc = 0; |
hdr->ansh_crc = htonl(crcAdler((u_char*) hdr, ntohs(hdr->ansh_len))); |
hdr->ansh_crc = htonl(crcAdler((u_char*) hdr, ntohs(hdr->ansh_len))); |
|
|
Line 230 icmpSend(int s, u_short id, char flg, u_int crypted, u
|
Line 277 icmpSend(int s, u_short id, char flg, u_int crypted, u
|
VERB(4) LOG("Put packet with len=%d", ret); |
VERB(4) LOG("Put packet with len=%d", ret); |
if (ret != sizeof(struct icmp) + sizeof(struct ansh_hdr) + datlen) { |
if (ret != sizeof(struct icmp) + sizeof(struct ansh_hdr) + datlen) { |
VERB(3) LOG("Sended data %d is different from source data len %d", ret, |
VERB(3) LOG("Sended data %d is different from source data len %d", ret, |
sizeof(struct icmp) + sizeof(struct ansh_hdr) + datlen); | (int) (sizeof(struct icmp) + sizeof(struct ansh_hdr) + datlen)); |
return ANSH_FLG_ERR; |
return ANSH_FLG_ERR; |
} |
} |
|
|
Line 238 icmpSend(int s, u_short id, char flg, u_int crypted, u
|
Line 285 icmpSend(int s, u_short id, char flg, u_int crypted, u
|
} |
} |
|
|
static int |
static int |
_pkt_Send(int s, char flg, u_int crypted, u_char *data, int datlen, struct ether_addr *ea) | _pkt_Send(int s, u_int seq, char flg, u_int crypted, u_char *data, int datlen, struct io_ether_addr *ea) |
{ |
{ |
u_char *pos, buf[USHRT_MAX] = { 0 }; |
u_char *pos, buf[USHRT_MAX] = { 0 }; |
struct ether_header *e = (struct ether_header*) buf; |
struct ether_header *e = (struct ether_header*) buf; |
Line 250 _pkt_Send(int s, char flg, u_int crypted, u_char *data
|
Line 297 _pkt_Send(int s, char flg, u_int crypted, u_char *data
|
return ANSH_FLG_ERR; |
return ANSH_FLG_ERR; |
|
|
e->ether_type = ntohs(ANSH_ID); |
e->ether_type = ntohs(ANSH_ID); |
memcpy(e->ether_dhost, ea->octet, ETHER_ADDR_LEN); | memcpy(e->ether_dhost, ea->ether_addr_octet, ETHER_ADDR_LEN); |
hdr = (struct ansh_hdr*) (buf + ETHER_HDR_LEN); |
hdr = (struct ansh_hdr*) (buf + ETHER_HDR_LEN); |
pos = ((u_char*) hdr) + sizeof(struct ansh_hdr); |
pos = ((u_char*) hdr) + sizeof(struct ansh_hdr); |
|
|
Line 260 _pkt_Send(int s, char flg, u_int crypted, u_char *data
|
Line 307 _pkt_Send(int s, char flg, u_int crypted, u_char *data
|
hdr->ansh_flg = flg; |
hdr->ansh_flg = flg; |
hdr->ansh_len = htons(datlen + sizeof(struct ansh_hdr)); |
hdr->ansh_len = htons(datlen + sizeof(struct ansh_hdr)); |
hdr->ansh_nonce = htonl(crypted); |
hdr->ansh_nonce = htonl(crypted); |
|
hdr->ansh_seq = htonl(seq); |
hdr->ansh_crc = 0; |
hdr->ansh_crc = 0; |
hdr->ansh_crc = htonl(crcAdler((u_char*) hdr, ntohs(hdr->ansh_len))); |
hdr->ansh_crc = htonl(crcAdler((u_char*) hdr, ntohs(hdr->ansh_len))); |
|
|
Line 270 _pkt_Send(int s, char flg, u_int crypted, u_char *data
|
Line 318 _pkt_Send(int s, char flg, u_int crypted, u_char *data
|
VERB(4) LOG("Put packet with len=%d", ret); |
VERB(4) LOG("Put packet with len=%d", ret); |
if (ret != ETHER_HDR_LEN + sizeof(struct ansh_hdr) + datlen) { |
if (ret != ETHER_HDR_LEN + sizeof(struct ansh_hdr) + datlen) { |
VERB(3) LOG("Sended data %d is different from source data len %d", ret, |
VERB(3) LOG("Sended data %d is different from source data len %d", ret, |
ETHER_HDR_LEN + sizeof(struct ansh_hdr) + datlen); | (int) (ETHER_HDR_LEN + sizeof(struct ansh_hdr) + datlen)); |
return ANSH_FLG_ERR; |
return ANSH_FLG_ERR; |
} |
} |
|
|
Line 278 _pkt_Send(int s, char flg, u_int crypted, u_char *data
|
Line 326 _pkt_Send(int s, char flg, u_int crypted, u_char *data
|
} |
} |
|
|
int |
int |
pktSend(int s, char flg, u_int crypted, u_char *data, int datlen, struct ether_addr *ea) | pktSend(int s, u_int seq, char flg, u_int crypted, u_char *data, int datlen, struct io_ether_addr *ea) |
{ |
{ |
int wlen, ret = 0; |
int wlen, ret = 0; |
u_char *pos = data; |
u_char *pos = data; |
|
|
while (datlen > -1) { |
while (datlen > -1) { |
wlen = _pkt_Send(s, flg, crypted, pos, (datlen > 512) ? 512 : datlen, ea); | wlen = _pkt_Send(s, seq, flg, crypted, pos, (datlen > 512) ? 512 : datlen, ea); |
if (wlen == -1) |
if (wlen == -1) |
return -1; |
return -1; |
else { |
else { |
Line 298 pktSend(int s, char flg, u_int crypted, u_char *data,
|
Line 346 pktSend(int s, char flg, u_int crypted, u_char *data,
|
} |
} |
|
|
static char |
static char |
_pkt_Recv(u_char * __restrict buf, int rlen, u_int * __restrict crypted, | _pkt_Recv(u_char * __restrict buf, int rlen, u_int * __restrict seq, u_int * __restrict crypted, |
u_char * __restrict data, int * __restrict datlen, |
u_char * __restrict data, int * __restrict datlen, |
u_char ** __restrict next, int * __restrict nextlen) |
u_char ** __restrict next, int * __restrict nextlen) |
{ |
{ |
Line 357 _pkt_Recv(u_char * __restrict buf, int rlen, u_int * _
|
Line 405 _pkt_Recv(u_char * __restrict buf, int rlen, u_int * _
|
memcpy(data, buf + bpf->bh_hdrlen + ETHER_HDR_LEN + sizeof(struct ansh_hdr), *datlen); |
memcpy(data, buf + bpf->bh_hdrlen + ETHER_HDR_LEN + sizeof(struct ansh_hdr), *datlen); |
} |
} |
|
|
|
if (seq) |
|
*seq = ntohl(hdr->ansh_seq); |
return hdr->ansh_flg; |
return hdr->ansh_flg; |
} |
} |
|
|
char |
char |
pktRecv(int s, u_int * __restrict crypted, u_char * __restrict data, int * __restrict datlen, | pktRecv(int s, u_int * __restrict seq, u_int * __restrict crypted, u_char * __restrict data, |
struct ether_header *eth) | int * __restrict datlen, struct ether_header *eth) |
{ |
{ |
u_char *buf, *next, *pos, *ptr; | u_char *buf, *next, *ptr, *pos = data; |
int nextlen, rlen, buflen, ptrlen; |
int nextlen, rlen, buflen, ptrlen; |
char flg; |
char flg; |
struct bpf_hdr *bpf; |
struct bpf_hdr *bpf; |
struct ether_header *e; |
struct ether_header *e; |
|
|
if (!eth || !datlen) | if (!eth || !data || !datlen) |
return ANSH_FLG_ERR; |
return ANSH_FLG_ERR; |
|
else |
|
memset(data, 0, *datlen); |
|
|
if (!(buf = malloc(*datlen))) { |
if (!(buf = malloc(*datlen))) { |
ERR("malloc() #%d - %s", errno, strerror(errno)); |
ERR("malloc() #%d - %s", errno, strerror(errno)); |
Line 399 pktRecv(int s, u_int * __restrict crypted, u_char * __
|
Line 451 pktRecv(int s, u_int * __restrict crypted, u_char * __
|
|
|
ptr = next = buf; |
ptr = next = buf; |
ptrlen = nextlen = rlen; |
ptrlen = nextlen = rlen; |
pos = data; | if ((flg = _pkt_Recv(ptr, ptrlen, seq, crypted, pos, &buflen, &next, &nextlen)) == -1) { |
buflen = *datlen; | |
if ((flg = _pkt_Recv(ptr, ptrlen, crypted, pos, &buflen, &next, &nextlen)) == -1) { | |
free(buf); |
free(buf); |
return ANSH_FLG_ERR; |
return ANSH_FLG_ERR; |
} else { |
} else { |
Line 410 pktRecv(int s, u_int * __restrict crypted, u_char * __
|
Line 460 pktRecv(int s, u_int * __restrict crypted, u_char * __
|
ptr = next; |
ptr = next; |
ptrlen = nextlen; |
ptrlen = nextlen; |
} |
} |
|
/* get additional packets from buffer */ |
while (next && nextlen > 0) |
while (next && nextlen > 0) |
if (_pkt_Recv(ptr, ptrlen, crypted, pos, &buflen, &next, &nextlen) == -1) | if (_pkt_Recv(ptr, ptrlen, seq, crypted, pos, &buflen, &next, &nextlen) == -1) |
break; |
break; |
else { |
else { |
pos += buflen; |
pos += buflen; |
Line 421 pktRecv(int s, u_int * __restrict crypted, u_char * __
|
Line 472 pktRecv(int s, u_int * __restrict crypted, u_char * __
|
} |
} |
|
|
free(buf); |
free(buf); |
|
|
return flg; |
return flg; |
} |
} |
|
|
Line 457 cryptBuffer(u_char *buf, int rlen, u_int ctr)
|
Line 509 cryptBuffer(u_char *buf, int rlen, u_int ctr)
|
memcpy(ivec + 8, &ctr, sizeof ctr); |
memcpy(ivec + 8, &ctr, sizeof ctr); |
memcpy(ivec + 12, &rctr, sizeof rctr); |
memcpy(ivec + 12, &rctr, sizeof rctr); |
|
|
if (io_ctr_AES(buf, rlen, &str, (u_char*) "_ansh_ELWIX_", ivec) == -1) | if (io_ctr_AES(buf, rlen, &str, (u_char*) Key, ivec) == -1) |
return NULL; |
return NULL; |
|
|
return str; |
return str; |