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

/*
 * Copyright (C) ST-Ericsson AB 2010
 * Author:	Sjur Brendeland
 * 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 <linux/pkt_sched.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;
			cfpkt_set_prio(pkt, TC_PRIO_CONTROL);
			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;
			cfpkt_set_prio(pkt, TC_PRIO_CONTROL);
			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) {
		*err = -ENOTCONN;
		return false;
	}
	return true;
}

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;

	if (WARN_ON(adapt_layer == NULL || adapt_layer->dn == NULL))
		return;
	service = container_of(adapt_layer->dn, struct cfsrvl, layer);
	service->hold = hold;
	service->put = put;
}
EXPORT_SYMBOL(caif_client_register_refcnt);
Commit	Line	Data
b482cd20 SB	1	/*
b482cd20 SB	2	* Copyright (C) ST-Ericsson AB 2010
26ee65e6	3	* Author: Sjur Brendeland
b482cd20 SB	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>
44764812	14	#include <linux/pkt_sched.h>
b482cd20 SB	15	#include <net/caif/caif_layer.h>
	16	#include <net/caif/cfsrvl.h>
	17	#include <net/caif/cfpkt.h>
	18
	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
	24
	25	#define container_obj(layr) container_of(layr, struct cfsrvl, layer)
	26
	27	static void cfservl_ctrlcmd(struct cflayer *layr, enum caif_ctrlcmd ctrl,
3bffc475	28	int phyid)
b482cd20 SB	29	{
b482cd20 SB	30	struct cfsrvl *service = container_obj(layr);
b1c74247	31
43e36921	32	if (layr->up == NULL \|\| layr->up->ctrlcmd == NULL)
43e36921	33	return;
b1c74247	34
b482cd20 SB	35	switch (ctrl) {
	36	case CAIF_CTRLCMD_INIT_RSP:
	37	service->open = true;
	38	layr->up->ctrlcmd(layr->up, ctrl, phyid);
	39	break;
	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);
	44	break;
	45	case _CAIF_CTRLCMD_PHYIF_FLOW_OFF_IND:
	46	if (phyid != service->dev_info.id)
	47	break;
	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;
	52	break;
	53	case _CAIF_CTRLCMD_PHYIF_FLOW_ON_IND:
	54	if (phyid != service->dev_info.id)
	55	return;
	56	if (service->modem_flow_on) {
	57	layr->up->ctrlcmd(layr->up,
	58	CAIF_CTRLCMD_FLOW_ON_IND,
	59	phyid);
	60	}
	61	service->phy_flow_on = true;
	62	break;
	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);
	67	}
	68	service->modem_flow_on = false;
	69	break;
	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);
	74	}
	75	service->modem_flow_on = true;
	76	break;
	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);
	81	break;
	82	case CAIF_CTRLCMD_REMOTE_SHUTDOWN_IND:
	83	layr->up->ctrlcmd(layr->up, ctrl, phyid);
	84	break;
	85	default:
b31fa5ba	86	pr_warn("Unexpected ctrl in cfsrvl (%d)\n", ctrl);
b482cd20 SB	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;
	90	break;
	91	}
	92	}
	93
	94	static int cfservl_modemcmd(struct cflayer *layr, enum caif_modemcmd ctrl)
	95	{
	96	struct cfsrvl *service = container_obj(layr);
b1c74247	97
b482cd20 SB	98	caif_assert(layr != NULL);
	99	caif_assert(layr->dn != NULL);
	100	caif_assert(layr->dn->transmit != NULL);
b1c74247 SB	101
	102	if (!service->supports_flowctrl)
	103	return 0;
	104
b482cd20 SB	105	switch (ctrl) {
	106	case CAIF_MODEMCMD_FLOW_ON_REQ:
	107	{
	108	struct cfpkt *pkt;
	109	struct caif_payload_info *info;
	110	u8 flow_on = SRVL_FLOW_ON;
	111	pkt = cfpkt_create(SRVL_CTRL_PKT_SIZE);
7ac2ed0c	112	if (!pkt)
b482cd20	113	return -ENOMEM;
b482cd20 SB	114
b482cd20 SB	115	if (cfpkt_add_head(pkt, &flow_on, 1) < 0) {
b31fa5ba	116	pr_err("Packet is erroneous!\n");
b482cd20 SB	117	cfpkt_destroy(pkt);
	118	return -EPROTO;
	119	}
	120	info = cfpkt_info(pkt);
	121	info->channel_id = service->layer.id;
	122	info->hdr_len = 1;
	123	info->dev_info = &service->dev_info;
44764812	124	cfpkt_set_prio(pkt, TC_PRIO_CONTROL);
b482cd20 SB	125	return layr->dn->transmit(layr->dn, pkt);
	126	}
	127	case CAIF_MODEMCMD_FLOW_OFF_REQ:
	128	{
	129	struct cfpkt *pkt;
	130	struct caif_payload_info *info;
	131	u8 flow_off = SRVL_FLOW_OFF;
	132	pkt = cfpkt_create(SRVL_CTRL_PKT_SIZE);
7ac2ed0c	133	if (!pkt)
638e628a	134	return -ENOMEM;
638e628a	135
b482cd20	136	if (cfpkt_add_head(pkt, &flow_off, 1) < 0) {
b31fa5ba	137	pr_err("Packet is erroneous!\n");
b482cd20 SB	138	cfpkt_destroy(pkt);
	139	return -EPROTO;
	140	}
	141	info = cfpkt_info(pkt);
	142	info->channel_id = service->layer.id;
	143	info->hdr_len = 1;
	144	info->dev_info = &service->dev_info;
44764812	145	cfpkt_set_prio(pkt, TC_PRIO_CONTROL);
b482cd20 SB	146	return layr->dn->transmit(layr->dn, pkt);
	147	}
	148	default:
	149	break;
	150	}
	151	return -EINVAL;
	152	}
	153
43e36921	154	static void cfsrvl_release(struct cflayer *layer)
a7da1f55	155	{
43e36921	156	struct cfsrvl *service = container_of(layer, struct cfsrvl, layer);
a7da1f55 SB	157	kfree(service);
	158	}
	159
b482cd20	160	void cfsrvl_init(struct cfsrvl *service,
3bffc475 SMP	161	u8 channel_id,
	162	struct dev_info *dev_info,
	163	bool supports_flowctrl)
b482cd20 SB	164	{
	165	caif_assert(offsetof(struct cfsrvl, layer) == 0);
	166	service->open = false;
	167	service->modem_flow_on = true;
	168	service->phy_flow_on = true;
	169	service->layer.id = channel_id;
	170	service->layer.ctrlcmd = cfservl_ctrlcmd;
	171	service->layer.modemcmd = cfservl_modemcmd;
	172	service->dev_info = *dev_info;
b1c74247	173	service->supports_flowctrl = supports_flowctrl;
a7da1f55	174	service->release = cfsrvl_release;
5b208656 SB	175	}
5b208656 SB	176
b482cd20 SB	177	bool cfsrvl_ready(struct cfsrvl service, int err)
b482cd20 SB	178	{
b482cd20 SB	179	if (!service->open) {
	180	*err = -ENOTCONN;
	181	return false;
	182	}
374458b3	183	return true;
b482cd20	184	}
43e36921	185
b482cd20 SB	186	u8 cfsrvl_getphyid(struct cflayer *layer)
	187	{
	188	struct cfsrvl *servl = container_obj(layer);
	189	return servl->dev_info.id;
	190	}
	191
	192	bool cfsrvl_phyid_match(struct cflayer *layer, int phyid)
	193	{
	194	struct cfsrvl *servl = container_obj(layer);
	195	return servl->dev_info.id == phyid;
	196	}
43e36921	197
	198	void caif_free_client(struct cflayer *adap_layer)
	199	{
	200	struct cfsrvl *servl;
	201	if (adap_layer == NULL \|\| adap_layer->dn == NULL)
	202	return;
	203	servl = container_obj(adap_layer->dn);
	204	servl->release(&servl->layer);
	205	}
	206	EXPORT_SYMBOL(caif_free_client);
	207
	208	void caif_client_register_refcnt(struct cflayer *adapt_layer,
3bffc475 SMP	209	void (hold)(struct cflayer lyr),
3bffc475 SMP	210	void (put)(struct cflayer lyr))
43e36921	211	{
43e36921	212	struct cfsrvl *service;
43e36921	213
566f26aa WY	214	if (WARN_ON(adapt_layer == NULL \|\| adapt_layer->dn == NULL))
	215	return;
	216	service = container_of(adapt_layer->dn, struct cfsrvl, layer);
43e36921	217	service->hold = hold;
	218	service->put = put;
	219	}
	220	EXPORT_SYMBOL(caif_client_register_refcnt);