linux-imx

/*

 * 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;