^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/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/types.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 <linux/errno.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <net/caif/caif_layer.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <net/caif/cfsrvl.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <net/caif/cfpkt.h>
^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) #define UTIL_PAYLOAD 0x00
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #define UTIL_CMD_BIT 0x80
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #define UTIL_REMOTE_SHUTDOWN 0x82
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) #define UTIL_FLOW_OFF 0x81
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) #define UTIL_FLOW_ON 0x80
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) static int cfutill_receive(struct cflayer *layr, struct cfpkt *pkt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) static int cfutill_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 *cfutill_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 *util = kzalloc(sizeof(struct cfsrvl), GFP_ATOMIC);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) if (!util)
^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(util, channel_id, dev_info, true);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) util->layer.receive = cfutill_receive;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) util->layer.transmit = cfutill_transmit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) snprintf(util->layer.name, CAIF_LAYER_NAME_SZ, "util1");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) return &util->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 cfutill_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) struct cfsrvl *service = container_obj(layr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) caif_assert(layr != NULL);
^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->up->receive != NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) caif_assert(layr->up->ctrlcmd != NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) if (cfpkt_extr_head(pkt, &cmd, 1) < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) pr_err("Packet is erroneous!\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) cfpkt_destroy(pkt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) return -EPROTO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) switch (cmd) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) case UTIL_PAYLOAD:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) return layr->up->receive(layr->up, pkt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) case UTIL_FLOW_OFF:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) layr->ctrlcmd(layr, CAIF_CTRLCMD_FLOW_OFF_IND, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) cfpkt_destroy(pkt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) case UTIL_FLOW_ON:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) layr->ctrlcmd(layr, CAIF_CTRLCMD_FLOW_ON_IND, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) cfpkt_destroy(pkt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) case UTIL_REMOTE_SHUTDOWN: /* Remote Shutdown Request */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) pr_err("REMOTE SHUTDOWN REQUEST RECEIVED\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) layr->ctrlcmd(layr, CAIF_CTRLCMD_REMOTE_SHUTDOWN_IND, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) service->open = false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) cfpkt_destroy(pkt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) cfpkt_destroy(pkt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) pr_warn("Unknown service control %d (0x%x)\n", cmd, cmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) return -EPROTO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) static int cfutill_transmit(struct cflayer *layr, struct cfpkt *pkt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) u8 zero = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) struct caif_payload_info *info;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) struct cfsrvl *service = container_obj(layr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) caif_assert(layr != NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) caif_assert(layr->dn != NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) caif_assert(layr->dn->transmit != NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) if (!cfsrvl_ready(service, &ret)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) cfpkt_destroy(pkt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) cfpkt_add_head(pkt, &zero, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) /* Add info for MUX-layer to route the packet out. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) info = cfpkt_info(pkt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) info->channel_id = service->layer.id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) * To optimize alignment, we add up the size of CAIF header before
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) * payload.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) info->hdr_len = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) info->dev_info = &service->dev_info;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) return layr->dn->transmit(layr->dn, pkt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) }
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags