diff options
Diffstat (limited to 'src/ipcpd')
| -rw-r--r-- | src/ipcpd/pci.c | 98 | ||||
| -rw-r--r-- | src/ipcpd/pci.h | 45 |
2 files changed, 143 insertions, 0 deletions
diff --git a/src/ipcpd/pci.c b/src/ipcpd/pci.c new file mode 100644 index 00000000..1987957a --- /dev/null +++ b/src/ipcpd/pci.c @@ -0,0 +1,98 @@ +/* + * Ouroboros - Copyright (C) 2016 + * + * Protocol Control Information + * + * Dimitri Staessens <[email protected]> + * Sander Vrijders <[email protected]> + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; either version 2 of the License, or + * (at your option) any later version. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with this program; if not, write to the Free Software + * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. + */ + +struct pci { + uint8_t * src_addr; + uint8_t * dst_addr; + uint8_t * pdu_length; + uint8_t * qos_id; + uint8_t * seqnr; + uint8_t * pad_h; + uint8_t * pad_t; + + uint8_t head_sz; + uint8_t tail_sz; + +}; + +pci_t * pci_create(struct dtp_const * dtc) +{ + int i = 0; + + if (dtc == NULL) + return NULL; + + struct pci * p = malloc(sizeof pci); + + if (p == NULL) + return NULL: + + p->src_addr =NULL; + p->dst_addr = NULL; + p->pdu_length = NULL; + p->qos_id = NULL; + p->seqnr = NULL; + p->pad_h = NULL; + p->pad_t = NULL; + + head_sz = 0; + tail_sz = 0; + + return p; +} + +/* policy... one could reorder the data fields + exercise left to the idiot that cares */ +int * pci_init(pci_t * pci, + d_buff_t * dub, + struct dtp_const * dtc, + struct dup_const * dupc) +{ + uint8_t * pci_head; + uint8_t * pci_tail; + + /* nastiness ahead, all members are uint8_t's */ + uint8_t * n = (uint8_t *) dtc; + for (i=0; i < sizeof *dtc; ++i) + n[i] & 0x80 ? tail_sz += n[i] & 0x80: + head_sz += n[i]; + head_sz += n[0] & 0x80 ? n[0] : 0; /* dst_addr */ + + n = (uint8_t *) dupc; + for (i=0; i < sizeof *dupc; ++i) + n[i] & 0x80 ? tail_sz += n[i] & 0x80 : + head_sz += n[i]; + tail_sz += n[0] & 0x80 ? n[0] : 0; /* dst_addr */ + + /* end of nastiness */ + + pci_head = du_buff_head_alloc(dub, head_sz); + pci_tail = du_buff_tail_alloc(dub, tail_sz); + + LOG_MISSING(); +} + +void pci_destroy(pci_t * pci) +{ + free (pci); +} diff --git a/src/ipcpd/pci.h b/src/ipcpd/pci.h new file mode 100644 index 00000000..936a1b1b --- /dev/null +++ b/src/ipcpd/pci.h @@ -0,0 +1,45 @@ +/* + * Ouroboros - Copyright (C) 2016 + * + * Protocol Control Information + * + * Dimitri Staessens <[email protected]> + * Sander Vrijders <[email protected]> + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; either version 2 of the License, or + * (at your option) any later version. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with this program; if not, write to the Free Software + * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. + */ + +#ifndef OUROBOROS_IPCP_PCI_H +#define OUROBOROS_IPCP_PCI_H +#endif + +#include "ouroboros/common.h" +#include "ouroboros/du_buff.h" + +struct pci; + +typedef struct pci pci_t; + +pci_t * pci_create(struct dtp_const * dtc); +void pci_destroy(pci_t * pci); + +int pci_init(pci_t * pci, + du_buff_t * dub, + struct dtp_const * dtc, + struct dup_const * dupc); + +int pci_release(du_buff_t dub); + +#endif /* OUROBOROS_IPCP_PCI_H */ |