[GitHub/mt8127/android_kernel_alcatel_ttab.git] / net / caif / cfsrvl.c

/*
 * Copyright (C) ST-Ericsson AB 2010
 * Author:	Sjur Brendeland/sjur.brandeland@stericsson.com
 * License terms: GNU General Public License (GPL) version 2
 */

#define pr_fmt(fmt) KBUILD_MODNAME ":%s(): " fmt, __func__

#include <linux/kernel.h>
#include <linux/types.h>
#include <linux/errno.h>
#include <linux/slab.h>
#include <linux/module.h>
#include <net/caif/caif_layer.h>
#include <net/caif/cfsrvl.h>
#include <net/caif/cfpkt.h>

#define SRVL_CTRL_PKT_SIZE 1
#define SRVL_FLOW_OFF 0x81
#define SRVL_FLOW_ON  0x80
#define SRVL_SET_PIN  0x82
#define SRVL_CTRL_PKT_SIZE 1

#define container_obj(layr) container_of(layr, struct cfsrvl, layer)

static void cfservl_ctrlcmd(struct cflayer *layr, enum caif_ctrlcmd ctrl,
				int phyid)
{
	struct cfsrvl *service = container_obj(layr);

	if (layr->up == NULL || layr->up->ctrlcmd == NULL)
		return;

	switch (ctrl) {
	case CAIF_CTRLCMD_INIT_RSP:
		service->open = true;
		layr->up->ctrlcmd(layr->up, ctrl, phyid);
		break;
	case CAIF_CTRLCMD_DEINIT_RSP:
	case CAIF_CTRLCMD_INIT_FAIL_RSP:
		service->open = false;
		layr->up->ctrlcmd(layr->up, ctrl, phyid);
		break;
	case _CAIF_CTRLCMD_PHYIF_FLOW_OFF_IND:
		if (phyid != service->dev_info.id)
			break;
		if (service->modem_flow_on)
			layr->up->ctrlcmd(layr->up,
					  CAIF_CTRLCMD_FLOW_OFF_IND, phyid);
		service->phy_flow_on = false;
		break;
	case _CAIF_CTRLCMD_PHYIF_FLOW_ON_IND:
		if (phyid != service->dev_info.id)
			return;
		if (service->modem_flow_on) {
			layr->up->ctrlcmd(layr->up,
					   CAIF_CTRLCMD_FLOW_ON_IND,
					   phyid);
		}
		service->phy_flow_on = true;
		break;
	case CAIF_CTRLCMD_FLOW_OFF_IND:
		if (service->phy_flow_on) {
			layr->up->ctrlcmd(layr->up,
					  CAIF_CTRLCMD_FLOW_OFF_IND, phyid);
		}
		service->modem_flow_on = false;
		break;
	case CAIF_CTRLCMD_FLOW_ON_IND:
		if (service->phy_flow_on) {
			layr->up->ctrlcmd(layr->up,
					  CAIF_CTRLCMD_FLOW_ON_IND, phyid);
		}
		service->modem_flow_on = true;
		break;
	case _CAIF_CTRLCMD_PHYIF_DOWN_IND:
		/* In case interface is down, let's fake a remove shutdown */
		layr->up->ctrlcmd(layr->up,
				CAIF_CTRLCMD_REMOTE_SHUTDOWN_IND, phyid);
		break;
	case CAIF_CTRLCMD_REMOTE_SHUTDOWN_IND:
		layr->up->ctrlcmd(layr->up, ctrl, phyid);
		break;
	default:
		pr_warn("Unexpected ctrl in cfsrvl (%d)\n", ctrl);
		/* We have both modem and phy flow on, send flow on */
		layr->up->ctrlcmd(layr->up, ctrl, phyid);
		service->phy_flow_on = true;
		break;
	}
}

static int cfservl_modemcmd(struct cflayer *layr, enum caif_modemcmd ctrl)
{
	struct cfsrvl *service = container_obj(layr);

	caif_assert(layr != NULL);
	caif_assert(layr->dn != NULL);
	caif_assert(layr->dn->transmit != NULL);

	if (!service->supports_flowctrl)
		return 0;

	switch (ctrl) {
	case CAIF_MODEMCMD_FLOW_ON_REQ:
		{
			struct cfpkt *pkt;
			struct caif_payload_info *info;
			u8 flow_on = SRVL_FLOW_ON;
			pkt = cfpkt_create(SRVL_CTRL_PKT_SIZE);
			if (!pkt)
				return -ENOMEM;

			if (cfpkt_add_head(pkt, &flow_on, 1) < 0) {
				pr_err("Packet is erroneous!\n");
				cfpkt_destroy(pkt);
				return -EPROTO;
			}
			info = cfpkt_info(pkt);
			info->channel_id = service->layer.id;
			info->hdr_len = 1;
			info->dev_info = &service->dev_info;
			return layr->dn->transmit(layr->dn, pkt);
		}
	case CAIF_MODEMCMD_FLOW_OFF_REQ:
		{
			struct cfpkt *pkt;
			struct caif_payload_info *info;
			u8 flow_off = SRVL_FLOW_OFF;
			pkt = cfpkt_create(SRVL_CTRL_PKT_SIZE);
			if (!pkt)
				return -ENOMEM;

			if (cfpkt_add_head(pkt, &flow_off, 1) < 0) {
				pr_err("Packet is erroneous!\n");
				cfpkt_destroy(pkt);
				return -EPROTO;
			}
			info = cfpkt_info(pkt);
			info->channel_id = service->layer.id;
			info->hdr_len = 1;
			info->dev_info = &service->dev_info;
			return layr->dn->transmit(layr->dn, pkt);
		}
	default:
	  break;
	}
	return -EINVAL;
}

static void cfsrvl_release(struct cflayer *layer)
{
	struct cfsrvl *service = container_of(layer, struct cfsrvl, layer);
	kfree(service);
}

void cfsrvl_init(struct cfsrvl *service,
			u8 channel_id,
			struct dev_info *dev_info,
			bool supports_flowctrl
			)
{
	caif_assert(offsetof(struct cfsrvl, layer) == 0);
	service->open = false;
	service->modem_flow_on = true;
	service->phy_flow_on = true;
	service->layer.id = channel_id;
	service->layer.ctrlcmd = cfservl_ctrlcmd;
	service->layer.modemcmd = cfservl_modemcmd;
	service->dev_info = *dev_info;
	service->supports_flowctrl = supports_flowctrl;
	service->release = cfsrvl_release;
}

bool cfsrvl_ready(struct cfsrvl *service, int *err)
{
	if (service->open && service->modem_flow_on && service->phy_flow_on)
		return true;
	if (!service->open) {
		*err = -ENOTCONN;
		return false;
	}
	caif_assert(!(service->modem_flow_on && service->phy_flow_on));
	*err = -EAGAIN;
	return false;
}

u8 cfsrvl_getphyid(struct cflayer *layer)
{
	struct cfsrvl *servl = container_obj(layer);
	return servl->dev_info.id;
}

bool cfsrvl_phyid_match(struct cflayer *layer, int phyid)
{
	struct cfsrvl *servl = container_obj(layer);
	return servl->dev_info.id == phyid;
}

void caif_free_client(struct cflayer *adap_layer)
{
	struct cfsrvl *servl;
	if (adap_layer == NULL || adap_layer->dn == NULL)
		return;
	servl = container_obj(adap_layer->dn);
	servl->release(&servl->layer);
}
EXPORT_SYMBOL(caif_free_client);

void caif_client_register_refcnt(struct cflayer *adapt_layer,
					void (*hold)(struct cflayer *lyr),
					void (*put)(struct cflayer *lyr))
{
	struct cfsrvl *service;
	service = container_of(adapt_layer->dn, struct cfsrvl, layer);

	WARN_ON(adapt_layer == NULL || adapt_layer->dn == NULL);
	service->hold = hold;
	service->put = put;
}
EXPORT_SYMBOL(caif_client_register_refcnt);
Commit	Line	Data
b482cd20 SB	1	/*
	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
	5	*/
	6
b31fa5ba JP	7	#define pr_fmt(fmt) KBUILD_MODNAME ":%s(): " fmt, __func__
b31fa5ba JP	8
b482cd20 SB	9	#include <linux/kernel.h>
	10	#include <linux/types.h>
	11	#include <linux/errno.h>
	12	#include <linux/slab.h>
43e36921	13	#include <linux/module.h>
b482cd20 SB	14	#include <net/caif/caif_layer.h>
	15	#include <net/caif/cfsrvl.h>
	16	#include <net/caif/cfpkt.h>
	17
	18	#define SRVL_CTRL_PKT_SIZE 1
	19	#define SRVL_FLOW_OFF 0x81
	20	#define SRVL_FLOW_ON 0x80
	21	#define SRVL_SET_PIN 0x82
	22	#define SRVL_CTRL_PKT_SIZE 1
	23
	24	#define container_obj(layr) container_of(layr, struct cfsrvl, layer)
	25
	26	static void cfservl_ctrlcmd(struct cflayer *layr, enum caif_ctrlcmd ctrl,
	27	int phyid)
	28	{
	29	struct cfsrvl *service = container_obj(layr);
b1c74247	30
43e36921	31	if (layr->up == NULL \|\| layr->up->ctrlcmd == NULL)
43e36921	32	return;
b1c74247	33
b482cd20 SB	34	switch (ctrl) {
	35	case CAIF_CTRLCMD_INIT_RSP:
	36	service->open = true;
	37	layr->up->ctrlcmd(layr->up, ctrl, phyid);
	38	break;
	39	case CAIF_CTRLCMD_DEINIT_RSP:
	40	case CAIF_CTRLCMD_INIT_FAIL_RSP:
	41	service->open = false;
	42	layr->up->ctrlcmd(layr->up, ctrl, phyid);
	43	break;
	44	case _CAIF_CTRLCMD_PHYIF_FLOW_OFF_IND:
	45	if (phyid != service->dev_info.id)
	46	break;
	47	if (service->modem_flow_on)
	48	layr->up->ctrlcmd(layr->up,
	49	CAIF_CTRLCMD_FLOW_OFF_IND, phyid);
	50	service->phy_flow_on = false;
	51	break;
	52	case _CAIF_CTRLCMD_PHYIF_FLOW_ON_IND:
	53	if (phyid != service->dev_info.id)
	54	return;
	55	if (service->modem_flow_on) {
	56	layr->up->ctrlcmd(layr->up,
	57	CAIF_CTRLCMD_FLOW_ON_IND,
	58	phyid);
	59	}
	60	service->phy_flow_on = true;
	61	break;
	62	case CAIF_CTRLCMD_FLOW_OFF_IND:
	63	if (service->phy_flow_on) {
	64	layr->up->ctrlcmd(layr->up,
	65	CAIF_CTRLCMD_FLOW_OFF_IND, phyid);
	66	}
	67	service->modem_flow_on = false;
	68	break;
	69	case CAIF_CTRLCMD_FLOW_ON_IND:
	70	if (service->phy_flow_on) {
	71	layr->up->ctrlcmd(layr->up,
	72	CAIF_CTRLCMD_FLOW_ON_IND, phyid);
	73	}
	74	service->modem_flow_on = true;
	75	break;
	76	case _CAIF_CTRLCMD_PHYIF_DOWN_IND:
	77	/* In case interface is down, let's fake a remove shutdown */
	78	layr->up->ctrlcmd(layr->up,
	79	CAIF_CTRLCMD_REMOTE_SHUTDOWN_IND, phyid);
	80	break;
	81	case CAIF_CTRLCMD_REMOTE_SHUTDOWN_IND:
	82	layr->up->ctrlcmd(layr->up, ctrl, phyid);
	83	break;
	84	default:
b31fa5ba	85	pr_warn("Unexpected ctrl in cfsrvl (%d)\n", ctrl);
b482cd20 SB	86	/* We have both modem and phy flow on, send flow on */
	87	layr->up->ctrlcmd(layr->up, ctrl, phyid);
	88	service->phy_flow_on = true;
	89	break;
	90	}
	91	}
	92
	93	static int cfservl_modemcmd(struct cflayer *layr, enum caif_modemcmd ctrl)
	94	{
	95	struct cfsrvl *service = container_obj(layr);
b1c74247	96
b482cd20 SB	97	caif_assert(layr != NULL);
	98	caif_assert(layr->dn != NULL);
	99	caif_assert(layr->dn->transmit != NULL);
b1c74247 SB	100
	101	if (!service->supports_flowctrl)
	102	return 0;
	103
b482cd20 SB	104	switch (ctrl) {
	105	case CAIF_MODEMCMD_FLOW_ON_REQ:
	106	{
	107	struct cfpkt *pkt;
	108	struct caif_payload_info *info;
	109	u8 flow_on = SRVL_FLOW_ON;
	110	pkt = cfpkt_create(SRVL_CTRL_PKT_SIZE);
7ac2ed0c	111	if (!pkt)
b482cd20	112	return -ENOMEM;
b482cd20 SB	113
b482cd20 SB	114	if (cfpkt_add_head(pkt, &flow_on, 1) < 0) {
b31fa5ba	115	pr_err("Packet is erroneous!\n");
b482cd20 SB	116	cfpkt_destroy(pkt);
	117	return -EPROTO;
	118	}
	119	info = cfpkt_info(pkt);
	120	info->channel_id = service->layer.id;
	121	info->hdr_len = 1;
	122	info->dev_info = &service->dev_info;
	123	return layr->dn->transmit(layr->dn, pkt);
	124	}
	125	case CAIF_MODEMCMD_FLOW_OFF_REQ:
	126	{
	127	struct cfpkt *pkt;
	128	struct caif_payload_info *info;
	129	u8 flow_off = SRVL_FLOW_OFF;
	130	pkt = cfpkt_create(SRVL_CTRL_PKT_SIZE);
7ac2ed0c	131	if (!pkt)
638e628a	132	return -ENOMEM;
638e628a	133
b482cd20	134	if (cfpkt_add_head(pkt, &flow_off, 1) < 0) {
b31fa5ba	135	pr_err("Packet is erroneous!\n");
b482cd20 SB	136	cfpkt_destroy(pkt);
	137	return -EPROTO;
	138	}
	139	info = cfpkt_info(pkt);
	140	info->channel_id = service->layer.id;
	141	info->hdr_len = 1;
	142	info->dev_info = &service->dev_info;
	143	return layr->dn->transmit(layr->dn, pkt);
	144	}
	145	default:
	146	break;
	147	}
	148	return -EINVAL;
	149	}
	150
43e36921	151	static void cfsrvl_release(struct cflayer *layer)
a7da1f55	152	{
43e36921	153	struct cfsrvl *service = container_of(layer, struct cfsrvl, layer);
a7da1f55 SB	154	kfree(service);
	155	}
	156
b482cd20	157	void cfsrvl_init(struct cfsrvl *service,
b1c74247 SB	158	u8 channel_id,
	159	struct dev_info *dev_info,
	160	bool supports_flowctrl
	161	)
b482cd20 SB	162	{
	163	caif_assert(offsetof(struct cfsrvl, layer) == 0);
	164	service->open = false;
	165	service->modem_flow_on = true;
	166	service->phy_flow_on = true;
	167	service->layer.id = channel_id;
	168	service->layer.ctrlcmd = cfservl_ctrlcmd;
	169	service->layer.modemcmd = cfservl_modemcmd;
	170	service->dev_info = *dev_info;
b1c74247	171	service->supports_flowctrl = supports_flowctrl;
a7da1f55	172	service->release = cfsrvl_release;
5b208656 SB	173	}
5b208656 SB	174
b482cd20 SB	175	bool cfsrvl_ready(struct cfsrvl service, int err)
	176	{
	177	if (service->open && service->modem_flow_on && service->phy_flow_on)
	178	return true;
	179	if (!service->open) {
	180	*err = -ENOTCONN;
	181	return false;
	182	}
	183	caif_assert(!(service->modem_flow_on && service->phy_flow_on));
	184	*err = -EAGAIN;
	185	return false;
	186	}
43e36921	187
b482cd20 SB	188	u8 cfsrvl_getphyid(struct cflayer *layer)
	189	{
	190	struct cfsrvl *servl = container_obj(layer);
	191	return servl->dev_info.id;
	192	}
	193
	194	bool cfsrvl_phyid_match(struct cflayer *layer, int phyid)
	195	{
	196	struct cfsrvl *servl = container_obj(layer);
	197	return servl->dev_info.id == phyid;
	198	}
43e36921	199
	200	void caif_free_client(struct cflayer *adap_layer)
	201	{
	202	struct cfsrvl *servl;
	203	if (adap_layer == NULL \|\| adap_layer->dn == NULL)
	204	return;
	205	servl = container_obj(adap_layer->dn);
	206	servl->release(&servl->layer);
	207	}
	208	EXPORT_SYMBOL(caif_free_client);
	209
	210	void caif_client_register_refcnt(struct cflayer *adapt_layer,
	211	void (hold)(struct cflayer lyr),
	212	void (put)(struct cflayer lyr))
	213	{
	214	struct cfsrvl *service;
	215	service = container_of(adapt_layer->dn, struct cfsrvl, layer);
	216
	217	WARN_ON(adapt_layer == NULL \|\| adapt_layer->dn == NULL);
	218	service->hold = hold;
	219	service->put = put;
	220	}
	221	EXPORT_SYMBOL(caif_client_register_refcnt);