Reworking IO
authorPhilipp Dunkel <Philipp Dunkel@d4452222-2f33-11de-9270-010000000000>
Fri, 24 Apr 2009 21:58:56 +0000 (21:58 +0000)
committerPhilipp Dunkel <Philipp Dunkel@d4452222-2f33-11de-9270-010000000000>
Fri, 24 Apr 2009 21:58:56 +0000 (21:58 +0000)
git-svn-id: http://svn.cacert.cl/Software/BirdShack@18 d4452222-2f33-11de-9270-010000000000

TailFeather/trunk/src/comm/Makefile [new file with mode: 0644]
TailFeather/trunk/src/comm/comm.c [new file with mode: 0644]
TailFeather/trunk/src/comm/comm.h [new file with mode: 0644]
TailFeather/trunk/src/comm/crc.c [new file with mode: 0644]
TailFeather/trunk/src/comm/crc.h [new file with mode: 0644]
TailFeather/trunk/src/comm/packet.c [new file with mode: 0644]
TailFeather/trunk/src/comm/packet.h [new file with mode: 0644]

diff --git a/TailFeather/trunk/src/comm/Makefile b/TailFeather/trunk/src/comm/Makefile
new file mode 100644 (file)
index 0000000..48f2fba
--- /dev/null
@@ -0,0 +1,5 @@
+AR=ar
+CC=gcc
+
+clean : 
+       rm -f *.o
diff --git a/TailFeather/trunk/src/comm/comm.c b/TailFeather/trunk/src/comm/comm.c
new file mode 100644 (file)
index 0000000..f9ee148
--- /dev/null
@@ -0,0 +1,29 @@
+/* 
+ For copyright information see copyright.txt of the project 
+ Author: Philipp Dunkel
+*/
+
+#include "comm.h"
+
+#include <stdlib.h>
+#include <strings.h>
+
+struct comm_t {
+       int read;
+       int write;
+};
+comm *comm_create(int readchnl, int writechnl) {
+       comm *channel = (comm *)malloc(sizeof(comm));
+       if (NULL == channel) {
+               return NULL;
+       }
+       channel->read = readchnl;
+       channel->write = writechnl;
+       return channel;
+}
+int comm_get(comm *chnl, char *buf, int buflen) {
+       return read(chnl->read,buf,buflen);
+}
+int comm_put(comm *chnl, const char *buf, const int buflen) {
+       return write(chnl->write,buf,buflen);
+}
diff --git a/TailFeather/trunk/src/comm/comm.h b/TailFeather/trunk/src/comm/comm.h
new file mode 100644 (file)
index 0000000..e512195
--- /dev/null
@@ -0,0 +1,16 @@
+/* 
+ For copyright information see copyright.txt of the project 
+ Author: Philipp Dunkel
+*/
+
+#ifndef comm_h
+#define comm_h
+
+struct comm_t;
+typedef struct comm_t comm;
+
+comm *comm_create(int readchnl, int writechnl);
+int comm_get(comm *chnl, char *buf, int buflen);
+int comm_put(comm *chnl, const char *buf, const int buflen);
+
+#endif
diff --git a/TailFeather/trunk/src/comm/crc.c b/TailFeather/trunk/src/comm/crc.c
new file mode 100644 (file)
index 0000000..f71ae37
--- /dev/null
@@ -0,0 +1,74 @@
+/* 
+ For copyright information see copyright.txt of the project 
+ Author: Philipp Dunkel
+*/
+
+#include "crc.h"
+
+static crc crctab[256] = {
+       0x00000000,
+       0x04C11DB7, 0x09823B6E, 0x0D4326D9, 0x130476DC, 0x17C56B6B,
+       0x1A864DB2, 0x1E475005, 0x2608EDB8, 0x22C9F00F, 0x2F8AD6D6,
+       0x2B4BCB61, 0x350C9B64, 0x31CD86D3, 0x3C8EA00A, 0x384FBDBD,
+       0x4C11DB70, 0x48D0C6C7, 0x4593E01E, 0x4152FDA9, 0x5F15ADAC,
+       0x5BD4B01B, 0x569796C2, 0x52568B75, 0x6A1936C8, 0x6ED82B7F,
+       0x639B0DA6, 0x675A1011, 0x791D4014, 0x7DDC5DA3, 0x709F7B7A,
+       0x745E66CD, 0x9823B6E0, 0x9CE2AB57, 0x91A18D8E, 0x95609039,
+       0x8B27C03C, 0x8FE6DD8B, 0x82A5FB52, 0x8664E6E5, 0xBE2B5B58,
+       0xBAEA46EF, 0xB7A96036, 0xB3687D81, 0xAD2F2D84, 0xA9EE3033,
+       0xA4AD16EA, 0xA06C0B5D, 0xD4326D90, 0xD0F37027, 0xDDB056FE,
+       0xD9714B49, 0xC7361B4C, 0xC3F706FB, 0xCEB42022, 0xCA753D95,
+       0xF23A8028, 0xF6FB9D9F, 0xFBB8BB46, 0xFF79A6F1, 0xE13EF6F4,
+       0xE5FFEB43, 0xE8BCCD9A, 0xEC7DD02D, 0x34867077, 0x30476DC0,
+       0x3D044B19, 0x39C556AE, 0x278206AB, 0x23431B1C, 0x2E003DC5,
+       0x2AC12072, 0x128E9DCF, 0x164F8078, 0x1B0CA6A1, 0x1FCDBB16,
+       0x018AEB13, 0x054BF6A4, 0x0808D07D, 0x0CC9CDCA, 0x7897AB07,
+       0x7C56B6B0, 0x71159069, 0x75D48DDE, 0x6B93DDDB, 0x6F52C06C,
+       0x6211E6B5, 0x66D0FB02, 0x5E9F46BF, 0x5A5E5B08, 0x571D7DD1,
+       0x53DC6066, 0x4D9B3063, 0x495A2DD4, 0x44190B0D, 0x40D816BA,
+       0xACA5C697, 0xA864DB20, 0xA527FDF9, 0xA1E6E04E, 0xBFA1B04B,
+       0xBB60ADFC, 0xB6238B25, 0xB2E29692, 0x8AAD2B2F, 0x8E6C3698,
+       0x832F1041, 0x87EE0DF6, 0x99A95DF3, 0x9D684044, 0x902B669D,
+       0x94EA7B2A, 0xE0B41DE7, 0xE4750050, 0xE9362689, 0xEDF73B3E,
+       0xF3B06B3B, 0xF771768C, 0xFA325055, 0xFEF34DE2, 0xC6BCF05F,
+       0xC27DEDE8, 0xCF3ECB31, 0xCBFFD686, 0xD5B88683, 0xD1799B34,
+       0xDC3ABDED, 0xD8FBA05A, 0x690CE0EE, 0x6DCDFD59, 0x608EDB80,
+       0x644FC637, 0x7A089632, 0x7EC98B85, 0x738AAD5C, 0x774BB0EB,
+       0x4F040D56, 0x4BC510E1, 0x46863638, 0x42472B8F, 0x5C007B8A,
+       0x58C1663D, 0x558240E4, 0x51435D53, 0x251D3B9E, 0x21DC2629,
+       0x2C9F00F0, 0x285E1D47, 0x36194D42, 0x32D850F5, 0x3F9B762C,
+       0x3B5A6B9B, 0x0315D626, 0x07D4CB91, 0x0A97ED48, 0x0E56F0FF,
+       0x1011A0FA, 0x14D0BD4D, 0x19939B94, 0x1D528623, 0xF12F560E,
+       0xF5EE4BB9, 0xF8AD6D60, 0xFC6C70D7, 0xE22B20D2, 0xE6EA3D65,
+       0xEBA91BBC, 0xEF68060B, 0xD727BBB6, 0xD3E6A601, 0xDEA580D8,
+       0xDA649D6F, 0xC423CD6A, 0xC0E2D0DD, 0xCDA1F604, 0xC960EBB3,
+       0xBD3E8D7E, 0xB9FF90C9, 0xB4BCB610, 0xB07DABA7, 0xAE3AFBA2,
+       0xAAFBE615, 0xA7B8C0CC, 0xA379DD7B, 0x9B3660C6, 0x9FF77D71,
+       0x92B45BA8, 0x9675461F, 0x8832161A, 0x8CF30BAD, 0x81B02D74,
+       0x857130C3, 0x5D8A9099, 0x594B8D2E, 0x5408ABF7, 0x50C9B640,
+       0x4E8EE645, 0x4A4FFBF2, 0x470CDD2B, 0x43CDC09C, 0x7B827D21,
+       0x7F436096, 0x7200464F, 0x76C15BF8, 0x68860BFD, 0x6C47164A,
+       0x61043093, 0x65C52D24, 0x119B4BE9, 0x155A565E, 0x18197087,
+       0x1CD86D30, 0x029F3D35, 0x065E2082, 0x0B1D065B, 0x0FDC1BEC,
+       0x3793A651, 0x3352BBE6, 0x3E119D3F, 0x3AD08088, 0x2497D08D,
+       0x2056CD3A, 0x2D15EBE3, 0x29D4F654, 0xC5A92679, 0xC1683BCE,
+       0xCC2B1D17, 0xC8EA00A0, 0xD6AD50A5, 0xD26C4D12, 0xDF2F6BCB,
+       0xDBEE767C, 0xE3A1CBC1, 0xE760D676, 0xEA23F0AF, 0xEEE2ED18,
+       0xF0A5BD1D, 0xF464A0AA, 0xF9278673, 0xFDE69BC4, 0x89B8FD09,
+       0x8D79E0BE, 0x803AC667, 0x84FBDBD0, 0x9ABC8BD5, 0x9E7D9662,
+       0x933EB0BB, 0x97FFAD0C, 0xAFB010B1, 0xAB710D06, 0xA6322BDF,
+       0xA2F33668, 0xBCB4666D, 0xB8757BDA, 0xB5365D03, 0xB1F740B4
+};
+
+static crc partial_crc(crc crcval, char *buf, int buflen) {
+       int idx = 0;
+       unsigned char byte = 0;
+       for (idx=0; idx < buflen; idx++) {
+               byte = 0x00 | buf[idx];
+               crcval = (crcval << 8) ^ crctab[(crcval >> 24) ^ byte];
+       }
+       return crcval;
+}
+static crc calculate_crc(char *buf, int buflen) {
+       return partial_crc(0, buf, buflen);
+}
diff --git a/TailFeather/trunk/src/comm/crc.h b/TailFeather/trunk/src/comm/crc.h
new file mode 100644 (file)
index 0000000..0e62f64
--- /dev/null
@@ -0,0 +1,14 @@
+/* 
+ For copyright information see copyright.txt of the project 
+ Author: Philipp Dunkel
+*/
+
+#ifndef crc_h
+#define crc_h
+
+typedef unsigned long crc;
+
+static crc partial_crc(crc crcval, char *buf, int buflen);
+static crc calculate_crc(char *buf, int buflen);
+
+#endif
diff --git a/TailFeather/trunk/src/comm/packet.c b/TailFeather/trunk/src/comm/packet.c
new file mode 100644 (file)
index 0000000..a37e426
--- /dev/null
@@ -0,0 +1,102 @@
+/* 
+ For copyright information see copyright.txt of the project 
+ Author: Philipp Dunkel
+*/
+
+#include "packet.h"
+#include <string.h>
+
+#include "crc.h"
+
+#define PACKET_MAXLEN 1024
+#define PACKET_LENTOT 4
+#define PACKET_LEN 2
+#define PACKET_NUMTOT 2
+#define PACKET_NUM 2
+#define PACKET_CHKSUM 4
+#define PACKET_HEADER (PACKET_LENTOT + PACKET_LEN + PACKET_NUM + PACKET_NUMTOT)
+#define PACKET_FOOTER (PACKET_CHKSUM)
+
+struct packet_t {
+       char *data;
+       unsigned long length;
+};
+
+void bytes2char(char *buf, int off, unsigned long data, int bytes) {
+       int idx;
+       for (idx=0; idx < bytes; idx++) {
+               buf[off + (bytes - idx)] = (data >> (idx * 8)) & 0xFF;
+       }
+}
+unsigned long char2bytes(const char buf, const int off, const int len) {
+       unsigned long result = 0;
+       int idx;
+       for (idx = 0; idx < len; idx++) {
+               result = result | (buf[off + idx] << (idx * 8));
+       }
+       return result;
+}
+
+packet *packet_create(const char *buf, const unsigned long buflen) {
+       packet *pkt = (packet*)malloc(sizeof(packet));
+       pkt->data = (char*)malloc(sizef(char) * buflen);
+       pkt->length = bufflen;
+       if (NULL == buf) {
+               memcpy(pkg->data,buf,buflen);
+       }
+       return pkt;
+}
+
+void packet_send(comm *channel, packet *pkt) {
+       int pkgnum = 0;
+       int pkgtot = 0;
+       int pkglen = 0;
+       unsigned long used = 0;
+       char header[PACKET_HEADER];
+       char footer[PACKET_FOOTER];
+       crc crcval = 0;
+       
+       pkgtot = (pkt->length / PACKET_MAXLEN);
+       pkgtot = ((pkgtot * PACKET_MAXLEN) < pkg->length) ? (pkgtot+1) : pkgtot;
+       
+       bytes2char(header,0,pkt->length,4);
+       bytes2char(header, PACKET_LENTOT + PACKET_LEN + PACKET_NUM, pkgtot, PACKET_NUMTOT);
+       
+       for (pkgnum=1; pkgnum <= pkgtot; pkgnum++) {
+               pkglen = ((pkt->length - used) > PACKET_MAXLEN) ? PACKET_MAXLEN : (pkt->length - used);
+               bytes2char(header,PACKET_LENTOT, pkglen, PACKET_LEN);
+               bytes2char(header,PACKET_LENTOT + PACKET_LEN, pkgnum, PACKET_NUM);
+               comm_put(channel, header, PACKET_HEADER);
+               comm_put(channel, pkt->data + used, pkglen);
+               crcval = calculate_crc(header,PACKET_HEADER);
+               crcval = partial_crc(crcval, pkt->data + used, pkglen);
+               bytes2char(footer,0,crcval,PACKET_FOOTER);
+               comm_put(channel, footer, PACKET_FOOTER);
+       }
+}
+packet *packet_recv(comm *channel) {
+       unsigned long pkg_lentot;
+       int pkg_len;
+       int pkg_numtot;
+       int pkg_num;
+       char header[PACKET_HEADER];
+       char footer[PACKET_FOOTER];
+       packet *result = NULL;
+       comm_get(channel,header,PACKET_HEADER);
+       pkg_lentot = char2bytes(header,0,PACKET_LENTOT);
+       pkg_len = char2bytes(header,PACKET_LENTOT,PACKET_LEN);
+       pkg_num = char2bytes(header,PACKET_LENTOT+PACKET_LEN,PACKET_NUM);
+       pkg_numtot = char2bytes(header,PACKET_LENTOT+PACKET_LEN+PACKET_NUM,PACKET_NUMTOT);
+       result = packet_create(NULL, pkg_lentot);
+       
+}
+
+void packet_destroy(packet *pkt) {
+       if (NULL == pkt) return;
+       if (NULL != pkt->data) {
+               free(pkt->data);
+               pkt->data = NULL;
+       }
+       pkt->length = -1;
+       free(pkt);
+}
diff --git a/TailFeather/trunk/src/comm/packet.h b/TailFeather/trunk/src/comm/packet.h
new file mode 100644 (file)
index 0000000..334f053
--- /dev/null
@@ -0,0 +1,19 @@
+/* 
+ For copyright information see copyright.txt of the project 
+ Author: Philipp Dunkel
+*/
+
+#ifndef packet_h
+#define packet_h
+
+#include "comm.h"
+
+struct packet_t;
+typedef struct packet_t packet;
+
+packet *packet_create(const char *buf, const unsigned long buflen);
+void packet_send(comm *channel, packet *pkt);
+packet *packet_recv(comm *channel);
+void packet_destroy(packet *pkt);
+
+#endif