2 * Copyright (C) ST-Ericsson AB 2010
3 * Author: Sjur Brendeland
4 * License terms: GNU General Public License (GPL) version 2
7 #define pr_fmt(fmt) KBUILD_MODNAME ":%s(): " fmt, __func__
9 #include <linux/kernel.h>
10 #include <linux/types.h>
11 #include <linux/slab.h>
12 #include <linux/errno.h>
13 #include <net/caif/caif_layer.h>
14 #include <net/caif/cfsrvl.h>
15 #include <net/caif/cfpkt.h>
17 #define container_obj(layr) ((struct cfsrvl *) layr)
18 #define UTIL_PAYLOAD 0x00
19 #define UTIL_CMD_BIT 0x80
20 #define UTIL_REMOTE_SHUTDOWN 0x82
21 #define UTIL_FLOW_OFF 0x81
22 #define UTIL_FLOW_ON 0x80
24 static int cfutill_receive(struct cflayer
*layr
, struct cfpkt
*pkt
);
25 static int cfutill_transmit(struct cflayer
*layr
, struct cfpkt
*pkt
);
27 struct cflayer
*cfutill_create(u8 channel_id
, struct dev_info
*dev_info
)
29 struct cfsrvl
*util
= kzalloc(sizeof(struct cfsrvl
), GFP_ATOMIC
);
32 caif_assert(offsetof(struct cfsrvl
, layer
) == 0);
33 cfsrvl_init(util
, channel_id
, dev_info
, true);
34 util
->layer
.receive
= cfutill_receive
;
35 util
->layer
.transmit
= cfutill_transmit
;
36 snprintf(util
->layer
.name
, CAIF_LAYER_NAME_SZ
, "util1");
40 static int cfutill_receive(struct cflayer
*layr
, struct cfpkt
*pkt
)
43 struct cfsrvl
*service
= container_obj(layr
);
44 caif_assert(layr
!= NULL
);
45 caif_assert(layr
->up
!= NULL
);
46 caif_assert(layr
->up
->receive
!= NULL
);
47 caif_assert(layr
->up
->ctrlcmd
!= NULL
);
48 if (cfpkt_extr_head(pkt
, &cmd
, 1) < 0) {
49 pr_err("Packet is erroneous!\n");
56 return layr
->up
->receive(layr
->up
, pkt
);
58 layr
->ctrlcmd(layr
, CAIF_CTRLCMD_FLOW_OFF_IND
, 0);
62 layr
->ctrlcmd(layr
, CAIF_CTRLCMD_FLOW_ON_IND
, 0);
65 case UTIL_REMOTE_SHUTDOWN
: /* Remote Shutdown Request */
66 pr_err("REMOTE SHUTDOWN REQUEST RECEIVED\n");
67 layr
->ctrlcmd(layr
, CAIF_CTRLCMD_REMOTE_SHUTDOWN_IND
, 0);
68 service
->open
= false;
73 pr_warn("Unknown service control %d (0x%x)\n", cmd
, cmd
);
78 static int cfutill_transmit(struct cflayer
*layr
, struct cfpkt
*pkt
)
81 struct caif_payload_info
*info
;
83 struct cfsrvl
*service
= container_obj(layr
);
84 caif_assert(layr
!= NULL
);
85 caif_assert(layr
->dn
!= NULL
);
86 caif_assert(layr
->dn
->transmit
!= NULL
);
88 if (!cfsrvl_ready(service
, &ret
)) {
93 cfpkt_add_head(pkt
, &zero
, 1);
94 /* Add info for MUX-layer to route the packet out. */
95 info
= cfpkt_info(pkt
);
96 info
->channel_id
= service
->layer
.id
;
98 * To optimize alignment, we add up the size of CAIF header before
102 info
->dev_info
= &service
->dev_info
;
103 return layr
->dn
->transmit(layr
->dn
, pkt
);