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/kernel.h>
10 #include <linux/types.h>
11 #include <linux/errno.h>
12 #include <linux/slab.h>
13 #include <linux/module.h>
14 #include <linux/pkt_sched.h>
15 #include <net/caif/caif_layer.h>
16 #include <net/caif/cfsrvl.h>
17 #include <net/caif/cfpkt.h>
19 #define SRVL_CTRL_PKT_SIZE 1
20 #define SRVL_FLOW_OFF 0x81
21 #define SRVL_FLOW_ON 0x80
22 #define SRVL_SET_PIN 0x82
23 #define SRVL_CTRL_PKT_SIZE 1
25 #define container_obj(layr) container_of(layr, struct cfsrvl, layer)
27 static void cfservl_ctrlcmd(struct cflayer
*layr
, enum caif_ctrlcmd ctrl
,
30 struct cfsrvl
*service
= container_obj(layr
);
32 if (layr
->up
== NULL
|| layr
->up
->ctrlcmd
== NULL
)
36 case CAIF_CTRLCMD_INIT_RSP
:
38 layr
->up
->ctrlcmd(layr
->up
, ctrl
, phyid
);
40 case CAIF_CTRLCMD_DEINIT_RSP
:
41 case CAIF_CTRLCMD_INIT_FAIL_RSP
:
42 service
->open
= false;
43 layr
->up
->ctrlcmd(layr
->up
, ctrl
, phyid
);
45 case _CAIF_CTRLCMD_PHYIF_FLOW_OFF_IND
:
46 if (phyid
!= service
->dev_info
.id
)
48 if (service
->modem_flow_on
)
49 layr
->up
->ctrlcmd(layr
->up
,
50 CAIF_CTRLCMD_FLOW_OFF_IND
, phyid
);
51 service
->phy_flow_on
= false;
53 case _CAIF_CTRLCMD_PHYIF_FLOW_ON_IND
:
54 if (phyid
!= service
->dev_info
.id
)
56 if (service
->modem_flow_on
) {
57 layr
->up
->ctrlcmd(layr
->up
,
58 CAIF_CTRLCMD_FLOW_ON_IND
,
61 service
->phy_flow_on
= true;
63 case CAIF_CTRLCMD_FLOW_OFF_IND
:
64 if (service
->phy_flow_on
) {
65 layr
->up
->ctrlcmd(layr
->up
,
66 CAIF_CTRLCMD_FLOW_OFF_IND
, phyid
);
68 service
->modem_flow_on
= false;
70 case CAIF_CTRLCMD_FLOW_ON_IND
:
71 if (service
->phy_flow_on
) {
72 layr
->up
->ctrlcmd(layr
->up
,
73 CAIF_CTRLCMD_FLOW_ON_IND
, phyid
);
75 service
->modem_flow_on
= true;
77 case _CAIF_CTRLCMD_PHYIF_DOWN_IND
:
78 /* In case interface is down, let's fake a remove shutdown */
79 layr
->up
->ctrlcmd(layr
->up
,
80 CAIF_CTRLCMD_REMOTE_SHUTDOWN_IND
, phyid
);
82 case CAIF_CTRLCMD_REMOTE_SHUTDOWN_IND
:
83 layr
->up
->ctrlcmd(layr
->up
, ctrl
, phyid
);
86 pr_warn("Unexpected ctrl in cfsrvl (%d)\n", ctrl
);
87 /* We have both modem and phy flow on, send flow on */
88 layr
->up
->ctrlcmd(layr
->up
, ctrl
, phyid
);
89 service
->phy_flow_on
= true;
94 static int cfservl_modemcmd(struct cflayer
*layr
, enum caif_modemcmd ctrl
)
96 struct cfsrvl
*service
= container_obj(layr
);
98 caif_assert(layr
!= NULL
);
99 caif_assert(layr
->dn
!= NULL
);
100 caif_assert(layr
->dn
->transmit
!= NULL
);
102 if (!service
->supports_flowctrl
)
106 case CAIF_MODEMCMD_FLOW_ON_REQ
:
109 struct caif_payload_info
*info
;
110 u8 flow_on
= SRVL_FLOW_ON
;
111 pkt
= cfpkt_create(SRVL_CTRL_PKT_SIZE
);
115 if (cfpkt_add_head(pkt
, &flow_on
, 1) < 0) {
116 pr_err("Packet is erroneous!\n");
120 info
= cfpkt_info(pkt
);
121 info
->channel_id
= service
->layer
.id
;
123 info
->dev_info
= &service
->dev_info
;
124 cfpkt_set_prio(pkt
, TC_PRIO_CONTROL
);
125 return layr
->dn
->transmit(layr
->dn
, pkt
);
127 case CAIF_MODEMCMD_FLOW_OFF_REQ
:
130 struct caif_payload_info
*info
;
131 u8 flow_off
= SRVL_FLOW_OFF
;
132 pkt
= cfpkt_create(SRVL_CTRL_PKT_SIZE
);
136 if (cfpkt_add_head(pkt
, &flow_off
, 1) < 0) {
137 pr_err("Packet is erroneous!\n");
141 info
= cfpkt_info(pkt
);
142 info
->channel_id
= service
->layer
.id
;
144 info
->dev_info
= &service
->dev_info
;
145 cfpkt_set_prio(pkt
, TC_PRIO_CONTROL
);
146 return layr
->dn
->transmit(layr
->dn
, pkt
);
154 static void cfsrvl_release(struct cflayer
*layer
)
156 struct cfsrvl
*service
= container_of(layer
, struct cfsrvl
, layer
);
160 void cfsrvl_init(struct cfsrvl
*service
,
162 struct dev_info
*dev_info
,
163 bool supports_flowctrl
166 caif_assert(offsetof(struct cfsrvl
, layer
) == 0);
167 service
->open
= false;
168 service
->modem_flow_on
= true;
169 service
->phy_flow_on
= true;
170 service
->layer
.id
= channel_id
;
171 service
->layer
.ctrlcmd
= cfservl_ctrlcmd
;
172 service
->layer
.modemcmd
= cfservl_modemcmd
;
173 service
->dev_info
= *dev_info
;
174 service
->supports_flowctrl
= supports_flowctrl
;
175 service
->release
= cfsrvl_release
;
178 bool cfsrvl_ready(struct cfsrvl
*service
, int *err
)
180 if (!service
->open
) {
187 u8
cfsrvl_getphyid(struct cflayer
*layer
)
189 struct cfsrvl
*servl
= container_obj(layer
);
190 return servl
->dev_info
.id
;
193 bool cfsrvl_phyid_match(struct cflayer
*layer
, int phyid
)
195 struct cfsrvl
*servl
= container_obj(layer
);
196 return servl
->dev_info
.id
== phyid
;
199 void caif_free_client(struct cflayer
*adap_layer
)
201 struct cfsrvl
*servl
;
202 if (adap_layer
== NULL
|| adap_layer
->dn
== NULL
)
204 servl
= container_obj(adap_layer
->dn
);
205 servl
->release(&servl
->layer
);
207 EXPORT_SYMBOL(caif_free_client
);
209 void caif_client_register_refcnt(struct cflayer
*adapt_layer
,
210 void (*hold
)(struct cflayer
*lyr
),
211 void (*put
)(struct cflayer
*lyr
))
213 struct cfsrvl
*service
;
215 if (WARN_ON(adapt_layer
== NULL
|| adapt_layer
->dn
== NULL
))
217 service
= container_of(adapt_layer
->dn
, struct cfsrvl
, layer
);
218 service
->hold
= hold
;
221 EXPORT_SYMBOL(caif_client_register_refcnt
);