2 * Copyright (C) ST-Ericsson AB 2010
3 * Author: Sjur Brendeland/sjur.brandeland@stericsson.com
4 * License terms: GNU General Public License (GPL) version 2
7 #define pr_fmt(fmt) KBUILD_MODNAME ":%s(): " fmt, __func__
9 #include <linux/stddef.h>
10 #include <linux/slab.h>
11 #include <net/caif/caif_layer.h>
12 #include <net/caif/cfsrvl.h>
13 #include <net/caif/cfpkt.h>
15 #define container_obj(layr) ((struct cfsrvl *) layr)
17 static int cfdbgl_receive(struct cflayer
*layr
, struct cfpkt
*pkt
);
18 static int cfdbgl_transmit(struct cflayer
*layr
, struct cfpkt
*pkt
);
20 struct cflayer
*cfdbgl_create(u8 channel_id
, struct dev_info
*dev_info
)
22 struct cfsrvl
*dbg
= kzalloc(sizeof(struct cfsrvl
), GFP_ATOMIC
);
25 caif_assert(offsetof(struct cfsrvl
, layer
) == 0);
26 cfsrvl_init(dbg
, channel_id
, dev_info
, false);
27 dbg
->layer
.receive
= cfdbgl_receive
;
28 dbg
->layer
.transmit
= cfdbgl_transmit
;
29 snprintf(dbg
->layer
.name
, CAIF_LAYER_NAME_SZ
- 1, "dbg%d", channel_id
);
33 static int cfdbgl_receive(struct cflayer
*layr
, struct cfpkt
*pkt
)
35 return layr
->up
->receive(layr
->up
, pkt
);
38 static int cfdbgl_transmit(struct cflayer
*layr
, struct cfpkt
*pkt
)
40 struct cfsrvl
*service
= container_obj(layr
);
41 struct caif_payload_info
*info
;
44 if (!cfsrvl_ready(service
, &ret
)) {
49 /* Add info for MUX-layer to route the packet out */
50 info
= cfpkt_info(pkt
);
51 info
->channel_id
= service
->layer
.id
;
52 info
->dev_info
= &service
->dev_info
;
54 return layr
->dn
->transmit(layr
->dn
, pkt
);