From: root Date: Mon, 6 Oct 2008 08:09:37 +0000 (-0400) Subject: add watcher X-Git-Url: http://git.joshuawise.com/netwatch.git/commitdiff_plain/172a5ba7dad6e9c7e38e4e5aa2607de3728f0ebf add watcher --- diff --git a/watcher/.gitignore b/watcher/.gitignore new file mode 100644 index 0000000..627c0f0 --- /dev/null +++ b/watcher/.gitignore @@ -0,0 +1 @@ +watcher diff --git a/watcher/Makefile b/watcher/Makefile new file mode 100644 index 0000000..cfcad73 --- /dev/null +++ b/watcher/Makefile @@ -0,0 +1,2 @@ +watcher: watcher.c + gcc -Wall -Werror -pedantic -std=gnu99 watcher.c -o watcher -lpcap diff --git a/watcher/watcher.c b/watcher/watcher.c new file mode 100644 index 0000000..8b1eef7 --- /dev/null +++ b/watcher/watcher.c @@ -0,0 +1,106 @@ +#include +#include +#include +#include + +char errbuf[PCAP_ERRBUF_SIZE]; + +char buf[0x8000]; + +typedef struct netwatch_frame { + char dest_mac[6]; + char src_mac[6]; + unsigned short whatthefuck; + unsigned short ethertype; + unsigned short buf_offset; + unsigned short buf_window; + char data[]; +} netwatch_frame; + +void out(char *buf, unsigned short start) +{ + int y,x; + buf += start; + printf("\x1B[0;0H"); + for (y = 0; y < 25; y++) + { + for (x = 0; x < 80; x++) + { + unsigned char c, col; + + c = *(buf++); + col = *(buf++); + + printf("\x1B[0;"); + switch (col & 0x7) + { + case 0: printf("30;"); break; + case 1: printf("34;"); break; + case 2: printf("32;"); break; + case 3: printf("36;"); break; + case 4: printf("31;"); break; + case 5: printf("35;"); break; + case 6: printf("33;"); break; + case 7: printf("37;"); break; + } + if (col & 0x8) + printf("1;"); + if (col & 0x80) + printf("5;"); + switch ((col >> 4) & 0x7) + { + case 0: printf("40"); break; + case 1: printf("44"); break; + case 2: printf("42"); break; + case 3: printf("46"); break; + case 4: printf("41"); break; + case 5: printf("45"); break; + case 6: printf("43"); break; + case 7: printf("47"); break; + } + + printf("m%c", c); + } + printf("\n"); + } +} + +void handler (u_char * user, const struct pcap_pkthdr *h, const u_char *bytes) +{ + netwatch_frame * f = (netwatch_frame *) bytes; + + int data_len = h->caplen - sizeof(netwatch_frame); + + if (data_len < 0) return; + + if (ntohs(f->ethertype) != 0x1337) return; + + if (data_len > sizeof(buf)) return; + + if (f->buf_offset + data_len > sizeof(buf)) + { + int wrap_pos = sizeof(buf) - f->buf_offset; + memcpy(buf + f->buf_offset, f->data, wrap_pos); + memcpy(buf, f->data + wrap_pos, data_len - wrap_pos); + } else { + memcpy(buf + f->buf_offset, f->data, data_len); + } + + out(buf, f->buf_window); +} + +int main() { + pcap_t * pcap; + + pcap = pcap_open_live(NULL, 65535, 1, 0, errbuf); + + if (!pcap) + { + printf("pcap_open_live: %s\n", errbuf); + exit(1); + } + + pcap_loop(pcap, -1, handler, NULL); + + return 0; +}