linux-imx

/*

 * Ultra Wide Band

 * Beacon management

 *

 * Copyright (C) 2005-2006 Intel Corporation

 * Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com>

 *

 * This program is free software; you can redistribute it and/or

 * modify it under the terms of the GNU General Public License version

 * 2 as published by the Free Software Foundation.

 *

 * This program is distributed in the hope that it will be useful,

 * but WITHOUT ANY WARRANTY; without even the implied warranty of

 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

 * GNU General Public License for more details.

 *

 * You should have received a copy of the GNU General Public License

 * along with this program; if not, write to the Free Software

 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA

 * 02110-1301, USA.

 *

 *

 * FIXME: docs

 */

#include <linux/kernel.h>

#include <linux/init.h>

#include <linux/module.h>

#include <linux/device.h>

#include <linux/err.h>

#include <linux/kdev_t.h>

#include <linux/slab.h>

​

#include "uwb-internal.h"

​

/* Start Beaconing command structure */

struct uwb_rc_cmd_start_beacon {

    struct uwb_rccb rccb;

    __le16 wBPSTOffset;

    u8 bChannelNumber;

} __attribute__((packed));

​

​

static int uwb_rc_start_beacon(struct uwb_rc *rc, u16 bpst_offset, u8 channel)

{

    int result;

    struct uwb_rc_cmd_start_beacon *cmd;

    struct uwb_rc_evt_confirm reply;

​

    cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);

    if (cmd == NULL)

        return -ENOMEM;

    cmd->rccb.bCommandType = UWB_RC_CET_GENERAL;

    cmd->rccb.wCommand = cpu_to_le16(UWB_RC_CMD_START_BEACON);

    cmd->wBPSTOffset = cpu_to_le16(bpst_offset);

    cmd->bChannelNumber = channel;

    reply.rceb.bEventType = UWB_RC_CET_GENERAL;

    reply.rceb.wEvent = UWB_RC_CMD_START_BEACON;

    result = uwb_rc_cmd(rc, "START-BEACON", &cmd->rccb, sizeof(*cmd),

                &reply.rceb, sizeof(reply));

    if (result < 0)

        goto error_cmd;

    if (reply.bResultCode != UWB_RC_RES_SUCCESS) {

        dev_err(&rc->uwb_dev.dev,

            "START-BEACON: command execution failed: %s (%d)\n",

            uwb_rc_strerror(reply.bResultCode), reply.bResultCode);

        result = -EIO;

    }

error_cmd:

    kfree(cmd);

    return result;

}

​

static int uwb_rc_stop_beacon(struct uwb_rc *rc)

{

    int result;

    struct uwb_rccb *cmd;

    struct uwb_rc_evt_confirm reply;

​

    cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);

    if (cmd == NULL)

        return -ENOMEM;

    cmd->bCommandType = UWB_RC_CET_GENERAL;

    cmd->wCommand = cpu_to_le16(UWB_RC_CMD_STOP_BEACON);

    reply.rceb.bEventType = UWB_RC_CET_GENERAL;

    reply.rceb.wEvent = UWB_RC_CMD_STOP_BEACON;

    result = uwb_rc_cmd(rc, "STOP-BEACON", cmd, sizeof(*cmd),

                &reply.rceb, sizeof(reply));

    if (result < 0)

        goto error_cmd;

    if (reply.bResultCode != UWB_RC_RES_SUCCESS) {

        dev_err(&rc->uwb_dev.dev,

            "STOP-BEACON: command execution failed: %s (%d)\n",