[deliverable/linux.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) {
				pr_warn("Out of memory\n");
				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) {
				pr_warn("Out of memory\n");
				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);
	111	if (!pkt) {
b31fa5ba	112	pr_warn("Out of memory\n");
b482cd20 SB	113	return -ENOMEM;
	114	}
	115
	116	if (cfpkt_add_head(pkt, &flow_on, 1) < 0) {
b31fa5ba	117	pr_err("Packet is erroneous!\n");
b482cd20 SB	118	cfpkt_destroy(pkt);
	119	return -EPROTO;
	120	}
	121	info = cfpkt_info(pkt);
	122	info->channel_id = service->layer.id;
	123	info->hdr_len = 1;
	124	info->dev_info = &service->dev_info;
	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);
638e628a	133	if (!pkt) {
b31fa5ba	134	pr_warn("Out of memory\n");
638e628a SB	135	return -ENOMEM;
	136	}
	137
b482cd20	138	if (cfpkt_add_head(pkt, &flow_off, 1) < 0) {
b31fa5ba	139	pr_err("Packet is erroneous!\n");
b482cd20 SB	140	cfpkt_destroy(pkt);
	141	return -EPROTO;
	142	}
	143	info = cfpkt_info(pkt);
	144	info->channel_id = service->layer.id;
	145	info->hdr_len = 1;
	146	info->dev_info = &service->dev_info;
	147	return layr->dn->transmit(layr->dn, pkt);
	148	}
	149	default:
	150	break;
	151	}
	152	return -EINVAL;
	153	}
	154
43e36921	155	static void cfsrvl_release(struct cflayer *layer)
a7da1f55	156	{
43e36921	157	struct cfsrvl *service = container_of(layer, struct cfsrvl, layer);
a7da1f55 SB	158	kfree(service);
	159	}
	160
b482cd20	161	void cfsrvl_init(struct cfsrvl *service,
b1c74247 SB	162	u8 channel_id,
	163	struct dev_info *dev_info,
	164	bool supports_flowctrl
	165	)
b482cd20 SB	166	{
	167	caif_assert(offsetof(struct cfsrvl, layer) == 0);
	168	service->open = false;
	169	service->modem_flow_on = true;
	170	service->phy_flow_on = true;
	171	service->layer.id = channel_id;
	172	service->layer.ctrlcmd = cfservl_ctrlcmd;
	173	service->layer.modemcmd = cfservl_modemcmd;
	174	service->dev_info = *dev_info;
b1c74247	175	service->supports_flowctrl = supports_flowctrl;
a7da1f55	176	service->release = cfsrvl_release;
5b208656 SB	177	}
5b208656 SB	178
b482cd20 SB	179	bool cfsrvl_ready(struct cfsrvl service, int err)
	180	{
	181	if (service->open && service->modem_flow_on && service->phy_flow_on)
	182	return true;
	183	if (!service->open) {
	184	*err = -ENOTCONN;
	185	return false;
	186	}
	187	caif_assert(!(service->modem_flow_on && service->phy_flow_on));
	188	*err = -EAGAIN;
	189	return false;
	190	}
43e36921	191
b482cd20 SB	192	u8 cfsrvl_getphyid(struct cflayer *layer)
	193	{
	194	struct cfsrvl *servl = container_obj(layer);
	195	return servl->dev_info.id;
	196	}
	197
	198	bool cfsrvl_phyid_match(struct cflayer *layer, int phyid)
	199	{
	200	struct cfsrvl *servl = container_obj(layer);
	201	return servl->dev_info.id == phyid;
	202	}
43e36921	203
	204	void caif_free_client(struct cflayer *adap_layer)
	205	{
	206	struct cfsrvl *servl;
	207	if (adap_layer == NULL \|\| adap_layer->dn == NULL)
	208	return;
	209	servl = container_obj(adap_layer->dn);
	210	servl->release(&servl->layer);
	211	}
	212	EXPORT_SYMBOL(caif_free_client);
	213
	214	void caif_client_register_refcnt(struct cflayer *adapt_layer,
	215	void (hold)(struct cflayer lyr),
	216	void (put)(struct cflayer lyr))
	217	{
	218	struct cfsrvl *service;
	219	service = container_of(adapt_layer->dn, struct cfsrvl, layer);
	220
	221	WARN_ON(adapt_layer == NULL \|\| adapt_layer->dn == NULL);
	222	service->hold = hold;
	223	service->put = put;
	224	}
	225	EXPORT_SYMBOL(caif_client_register_refcnt);