forked from torvalds/linux
-
Notifications
You must be signed in to change notification settings - Fork 1
Commit
This commit does not belong to any branch on this repository, and may belong to a fork outside of the repository.
net-caif: add CAIF core protocol stack
CAIF generic protocol implementation. This layer is somewhat generic in order to be able to use and test it outside the Linux Kernel. cfctrl.c - CAIF control protocol layer cfdbgl.c - CAIF debug protocol layer cfdgml.c - CAIF datagram protocol layer cffrml.c - CAIF framing protocol layer cfmuxl.c - CAIF mux protocol layer cfrfml.c - CAIF remote file manager protocol layer cfserl.c - CAIF serial (fragmentation) protocol layer cfsrvl.c - CAIF generic service layer functions cfutill.c - CAIF utility protocol layer cfveil.c - CAIF AT protocol layer cfvidl.c - CAIF video protocol layer Signed-off-by: Sjur Braendeland <[email protected]> Signed-off-by: David S. Miller <[email protected]>
- Loading branch information
Showing
11 changed files
with
1,981 additions
and
0 deletions.
There are no files selected for viewing
Large diffs are not rendered by default.
Oops, something went wrong.
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
| Original file line number | Diff line number | Diff line change |
|---|---|---|
| @@ -0,0 +1,40 @@ | ||
| /* | ||
| * Copyright (C) ST-Ericsson AB 2010 | ||
| * Author: Sjur Brendeland/[email protected] | ||
| * License terms: GNU General Public License (GPL) version 2 | ||
| */ | ||
|
|
||
| #include <linux/stddef.h> | ||
| #include <linux/slab.h> | ||
| #include <net/caif/caif_layer.h> | ||
| #include <net/caif/cfsrvl.h> | ||
| #include <net/caif/cfpkt.h> | ||
|
|
||
| static int cfdbgl_receive(struct cflayer *layr, struct cfpkt *pkt); | ||
| static int cfdbgl_transmit(struct cflayer *layr, struct cfpkt *pkt); | ||
|
|
||
| struct cflayer *cfdbgl_create(u8 channel_id, struct dev_info *dev_info) | ||
| { | ||
| struct cfsrvl *dbg = kmalloc(sizeof(struct cfsrvl), GFP_ATOMIC); | ||
| if (!dbg) { | ||
| pr_warning("CAIF: %s(): Out of memory\n", __func__); | ||
| return NULL; | ||
| } | ||
| caif_assert(offsetof(struct cfsrvl, layer) == 0); | ||
| memset(dbg, 0, sizeof(struct cfsrvl)); | ||
| cfsrvl_init(dbg, channel_id, dev_info); | ||
| dbg->layer.receive = cfdbgl_receive; | ||
| dbg->layer.transmit = cfdbgl_transmit; | ||
| snprintf(dbg->layer.name, CAIF_LAYER_NAME_SZ - 1, "dbg%d", channel_id); | ||
| return &dbg->layer; | ||
| } | ||
|
|
||
| static int cfdbgl_receive(struct cflayer *layr, struct cfpkt *pkt) | ||
| { | ||
| return layr->up->receive(layr->up, pkt); | ||
| } | ||
|
|
||
| static int cfdbgl_transmit(struct cflayer *layr, struct cfpkt *pkt) | ||
| { | ||
| return layr->dn->transmit(layr->dn, pkt); | ||
| } |
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
| Original file line number | Diff line number | Diff line change |
|---|---|---|
| @@ -0,0 +1,108 @@ | ||
| /* | ||
| * Copyright (C) ST-Ericsson AB 2010 | ||
| * Author: Sjur Brendeland/[email protected] | ||
| * License terms: GNU General Public License (GPL) version 2 | ||
| */ | ||
|
|
||
| #include <linux/stddef.h> | ||
| #include <linux/spinlock.h> | ||
| #include <linux/slab.h> | ||
| #include <net/caif/caif_layer.h> | ||
| #include <net/caif/cfsrvl.h> | ||
| #include <net/caif/cfpkt.h> | ||
|
|
||
| #define container_obj(layr) ((struct cfsrvl *) layr) | ||
|
|
||
| #define DGM_CMD_BIT 0x80 | ||
| #define DGM_FLOW_OFF 0x81 | ||
| #define DGM_FLOW_ON 0x80 | ||
| #define DGM_CTRL_PKT_SIZE 1 | ||
|
|
||
| static int cfdgml_receive(struct cflayer *layr, struct cfpkt *pkt); | ||
| static int cfdgml_transmit(struct cflayer *layr, struct cfpkt *pkt); | ||
|
|
||
| struct cflayer *cfdgml_create(u8 channel_id, struct dev_info *dev_info) | ||
| { | ||
| struct cfsrvl *dgm = kmalloc(sizeof(struct cfsrvl), GFP_ATOMIC); | ||
| if (!dgm) { | ||
| pr_warning("CAIF: %s(): Out of memory\n", __func__); | ||
| return NULL; | ||
| } | ||
| caif_assert(offsetof(struct cfsrvl, layer) == 0); | ||
| memset(dgm, 0, sizeof(struct cfsrvl)); | ||
| cfsrvl_init(dgm, channel_id, dev_info); | ||
| dgm->layer.receive = cfdgml_receive; | ||
| dgm->layer.transmit = cfdgml_transmit; | ||
| snprintf(dgm->layer.name, CAIF_LAYER_NAME_SZ - 1, "dgm%d", channel_id); | ||
| dgm->layer.name[CAIF_LAYER_NAME_SZ - 1] = '\0'; | ||
| return &dgm->layer; | ||
| } | ||
|
|
||
| static int cfdgml_receive(struct cflayer *layr, struct cfpkt *pkt) | ||
| { | ||
| u8 cmd = -1; | ||
| u8 dgmhdr[3]; | ||
| int ret; | ||
| caif_assert(layr->up != NULL); | ||
| caif_assert(layr->receive != NULL); | ||
| caif_assert(layr->ctrlcmd != NULL); | ||
|
|
||
| if (cfpkt_extr_head(pkt, &cmd, 1) < 0) { | ||
| pr_err("CAIF: %s(): Packet is erroneous!\n", __func__); | ||
| cfpkt_destroy(pkt); | ||
| return -EPROTO; | ||
| } | ||
|
|
||
| if ((cmd & DGM_CMD_BIT) == 0) { | ||
| if (cfpkt_extr_head(pkt, &dgmhdr, 3) < 0) { | ||
| pr_err("CAIF: %s(): Packet is erroneous!\n", __func__); | ||
| cfpkt_destroy(pkt); | ||
| return -EPROTO; | ||
| } | ||
| ret = layr->up->receive(layr->up, pkt); | ||
| return ret; | ||
| } | ||
|
|
||
| switch (cmd) { | ||
| case DGM_FLOW_OFF: /* FLOW OFF */ | ||
| layr->ctrlcmd(layr, CAIF_CTRLCMD_FLOW_OFF_IND, 0); | ||
| cfpkt_destroy(pkt); | ||
| return 0; | ||
| case DGM_FLOW_ON: /* FLOW ON */ | ||
| layr->ctrlcmd(layr, CAIF_CTRLCMD_FLOW_ON_IND, 0); | ||
| cfpkt_destroy(pkt); | ||
| return 0; | ||
| default: | ||
| cfpkt_destroy(pkt); | ||
| pr_info("CAIF: %s(): Unknown datagram control %d (0x%x)\n", | ||
| __func__, cmd, cmd); | ||
| return -EPROTO; | ||
| } | ||
| } | ||
|
|
||
| static int cfdgml_transmit(struct cflayer *layr, struct cfpkt *pkt) | ||
| { | ||
| u32 zero = 0; | ||
| struct caif_payload_info *info; | ||
| struct cfsrvl *service = container_obj(layr); | ||
| int ret; | ||
| if (!cfsrvl_ready(service, &ret)) | ||
| return ret; | ||
|
|
||
| cfpkt_add_head(pkt, &zero, 4); | ||
|
|
||
| /* Add info for MUX-layer to route the packet out. */ | ||
| info = cfpkt_info(pkt); | ||
| info->channel_id = service->layer.id; | ||
| /* To optimize alignment, we add up the size of CAIF header | ||
| * before payload. | ||
| */ | ||
| info->hdr_len = 4; | ||
| info->dev_info = &service->dev_info; | ||
| ret = layr->dn->transmit(layr->dn, pkt); | ||
| if (ret < 0) { | ||
| u32 tmp32; | ||
| cfpkt_extr_head(pkt, &tmp32, 4); | ||
| } | ||
| return ret; | ||
| } |
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
| Original file line number | Diff line number | Diff line change |
|---|---|---|
| @@ -0,0 +1,151 @@ | ||
| /* | ||
| * CAIF Framing Layer. | ||
| * | ||
| * Copyright (C) ST-Ericsson AB 2010 | ||
| * Author: Sjur Brendeland/[email protected] | ||
| * License terms: GNU General Public License (GPL) version 2 | ||
| */ | ||
|
|
||
| #include <linux/stddef.h> | ||
| #include <linux/spinlock.h> | ||
| #include <linux/slab.h> | ||
| #include <linux/crc-ccitt.h> | ||
| #include <net/caif/caif_layer.h> | ||
| #include <net/caif/cfpkt.h> | ||
| #include <net/caif/cffrml.h> | ||
|
|
||
| #define container_obj(layr) container_of(layr, struct cffrml, layer) | ||
|
|
||
| struct cffrml { | ||
| struct cflayer layer; | ||
| bool dofcs; /* !< FCS active */ | ||
| }; | ||
|
|
||
| static int cffrml_receive(struct cflayer *layr, struct cfpkt *pkt); | ||
| static int cffrml_transmit(struct cflayer *layr, struct cfpkt *pkt); | ||
| static void cffrml_ctrlcmd(struct cflayer *layr, enum caif_ctrlcmd ctrl, | ||
| int phyid); | ||
|
|
||
| static u32 cffrml_rcv_error; | ||
| static u32 cffrml_rcv_checsum_error; | ||
| struct cflayer *cffrml_create(u16 phyid, bool use_fcs) | ||
| { | ||
| struct cffrml *this = kmalloc(sizeof(struct cffrml), GFP_ATOMIC); | ||
| if (!this) { | ||
| pr_warning("CAIF: %s(): Out of memory\n", __func__); | ||
| return NULL; | ||
| } | ||
| caif_assert(offsetof(struct cffrml, layer) == 0); | ||
|
|
||
| memset(this, 0, sizeof(struct cflayer)); | ||
| this->layer.receive = cffrml_receive; | ||
| this->layer.transmit = cffrml_transmit; | ||
| this->layer.ctrlcmd = cffrml_ctrlcmd; | ||
| snprintf(this->layer.name, CAIF_LAYER_NAME_SZ, "frm%d", phyid); | ||
| this->dofcs = use_fcs; | ||
| this->layer.id = phyid; | ||
| return (struct cflayer *) this; | ||
| } | ||
|
|
||
| void cffrml_set_uplayer(struct cflayer *this, struct cflayer *up) | ||
| { | ||
| this->up = up; | ||
| } | ||
|
|
||
| void cffrml_set_dnlayer(struct cflayer *this, struct cflayer *dn) | ||
| { | ||
| this->dn = dn; | ||
| } | ||
|
|
||
| static u16 cffrml_checksum(u16 chks, void *buf, u16 len) | ||
| { | ||
| /* FIXME: FCS should be moved to glue in order to use OS-Specific | ||
| * solutions | ||
| */ | ||
| return crc_ccitt(chks, buf, len); | ||
| } | ||
|
|
||
| static int cffrml_receive(struct cflayer *layr, struct cfpkt *pkt) | ||
| { | ||
| u16 tmp; | ||
| u16 len; | ||
| u16 hdrchks; | ||
| u16 pktchks; | ||
| struct cffrml *this; | ||
| this = container_obj(layr); | ||
|
|
||
| cfpkt_extr_head(pkt, &tmp, 2); | ||
| len = le16_to_cpu(tmp); | ||
|
|
||
| /* Subtract for FCS on length if FCS is not used. */ | ||
| if (!this->dofcs) | ||
| len -= 2; | ||
|
|
||
| if (cfpkt_setlen(pkt, len) < 0) { | ||
| ++cffrml_rcv_error; | ||
| pr_err("CAIF: %s():Framing length error (%d)\n", __func__, len); | ||
| cfpkt_destroy(pkt); | ||
| return -EPROTO; | ||
| } | ||
| /* | ||
| * Don't do extract if FCS is false, rather do setlen - then we don't | ||
| * get a cache-miss. | ||
| */ | ||
| if (this->dofcs) { | ||
| cfpkt_extr_trail(pkt, &tmp, 2); | ||
| hdrchks = le16_to_cpu(tmp); | ||
| pktchks = cfpkt_iterate(pkt, cffrml_checksum, 0xffff); | ||
| if (pktchks != hdrchks) { | ||
| cfpkt_add_trail(pkt, &tmp, 2); | ||
| ++cffrml_rcv_error; | ||
| ++cffrml_rcv_checsum_error; | ||
| pr_info("CAIF: %s(): Frame checksum error " | ||
| "(0x%x != 0x%x)\n", __func__, hdrchks, pktchks); | ||
| return -EILSEQ; | ||
| } | ||
| } | ||
| if (cfpkt_erroneous(pkt)) { | ||
| ++cffrml_rcv_error; | ||
| pr_err("CAIF: %s(): Packet is erroneous!\n", __func__); | ||
| cfpkt_destroy(pkt); | ||
| return -EPROTO; | ||
| } | ||
| return layr->up->receive(layr->up, pkt); | ||
| } | ||
|
|
||
| static int cffrml_transmit(struct cflayer *layr, struct cfpkt *pkt) | ||
| { | ||
| int tmp; | ||
| u16 chks; | ||
| u16 len; | ||
| int ret; | ||
| struct cffrml *this = container_obj(layr); | ||
| if (this->dofcs) { | ||
| chks = cfpkt_iterate(pkt, cffrml_checksum, 0xffff); | ||
| tmp = cpu_to_le16(chks); | ||
| cfpkt_add_trail(pkt, &tmp, 2); | ||
| } else { | ||
| cfpkt_pad_trail(pkt, 2); | ||
| } | ||
| len = cfpkt_getlen(pkt); | ||
| tmp = cpu_to_le16(len); | ||
| cfpkt_add_head(pkt, &tmp, 2); | ||
| cfpkt_info(pkt)->hdr_len += 2; | ||
| if (cfpkt_erroneous(pkt)) { | ||
| pr_err("CAIF: %s(): Packet is erroneous!\n", __func__); | ||
| return -EPROTO; | ||
| } | ||
| ret = layr->dn->transmit(layr->dn, pkt); | ||
| if (ret < 0) { | ||
| /* Remove header on faulty packet. */ | ||
| cfpkt_extr_head(pkt, &tmp, 2); | ||
| } | ||
| return ret; | ||
| } | ||
|
|
||
| static void cffrml_ctrlcmd(struct cflayer *layr, enum caif_ctrlcmd ctrl, | ||
| int phyid) | ||
| { | ||
| if (layr->up->ctrlcmd) | ||
| layr->up->ctrlcmd(layr->up, ctrl, layr->id); | ||
| } |
Oops, something went wrong.