^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * Copyright (C) ST-Ericsson AB 2010
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) * Author: Sjur Brendeland
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) #define pr_fmt(fmt) KBUILD_MODNAME ":%s(): " fmt, __func__
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) #include <linux/stddef.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/spinlock.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <net/caif/caif_layer.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <net/caif/cfsrvl.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <net/caif/cfpkt.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #define container_obj(layr) ((struct cfsrvl *) layr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #define DGM_CMD_BIT 0x80
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #define DGM_FLOW_OFF 0x81
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) #define DGM_FLOW_ON 0x80
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) #define DGM_MTU 1500
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) static int cfdgml_receive(struct cflayer *layr, struct cfpkt *pkt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) static int cfdgml_transmit(struct cflayer *layr, struct cfpkt *pkt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) struct cflayer *cfdgml_create(u8 channel_id, struct dev_info *dev_info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) struct cfsrvl *dgm = kzalloc(sizeof(struct cfsrvl), GFP_ATOMIC);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) if (!dgm)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) caif_assert(offsetof(struct cfsrvl, layer) == 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) cfsrvl_init(dgm, channel_id, dev_info, true);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) dgm->layer.receive = cfdgml_receive;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) dgm->layer.transmit = cfdgml_transmit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) snprintf(dgm->layer.name, CAIF_LAYER_NAME_SZ, "dgm%d", channel_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) return &dgm->layer;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) static int cfdgml_receive(struct cflayer *layr, struct cfpkt *pkt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) u8 cmd = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) u8 dgmhdr[3];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) caif_assert(layr->up != NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) caif_assert(layr->receive != NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) caif_assert(layr->ctrlcmd != NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) if (cfpkt_extr_head(pkt, &cmd, 1) < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) pr_err("Packet is erroneous!\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) cfpkt_destroy(pkt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) return -EPROTO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) if ((cmd & DGM_CMD_BIT) == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) if (cfpkt_extr_head(pkt, &dgmhdr, 3) < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) pr_err("Packet is erroneous!\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) cfpkt_destroy(pkt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) return -EPROTO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) ret = layr->up->receive(layr->up, pkt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) switch (cmd) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) case DGM_FLOW_OFF: /* FLOW OFF */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) layr->ctrlcmd(layr, CAIF_CTRLCMD_FLOW_OFF_IND, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) cfpkt_destroy(pkt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) case DGM_FLOW_ON: /* FLOW ON */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) layr->ctrlcmd(layr, CAIF_CTRLCMD_FLOW_ON_IND, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) cfpkt_destroy(pkt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) cfpkt_destroy(pkt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) pr_info("Unknown datagram control %d (0x%x)\n", cmd, cmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) return -EPROTO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) static int cfdgml_transmit(struct cflayer *layr, struct cfpkt *pkt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) u8 packet_type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) u32 zero = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) struct caif_payload_info *info;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) struct cfsrvl *service = container_obj(layr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) if (!cfsrvl_ready(service, &ret)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) cfpkt_destroy(pkt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) /* STE Modem cannot handle more than 1500 bytes datagrams */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) if (cfpkt_getlen(pkt) > DGM_MTU) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) cfpkt_destroy(pkt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) return -EMSGSIZE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) cfpkt_add_head(pkt, &zero, 3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) packet_type = 0x08; /* B9 set - UNCLASSIFIED */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) cfpkt_add_head(pkt, &packet_type, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) /* Add info for MUX-layer to route the packet out. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) info = cfpkt_info(pkt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) info->channel_id = service->layer.id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) /* To optimize alignment, we add up the size of CAIF header
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) * before payload.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) info->hdr_len = 4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) info->dev_info = &service->dev_info;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) return layr->dn->transmit(layr->dn, pkt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) }
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags