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