linux-vybrid_public/drivers/net/wireless/iwmc3200wifi/rfkill.c

/*
 * Intel Wireless Multicomm 3200 WiFi driver
 *
 * Copyright (C) 2009 Intel Corporation <ilw@linux.intel.com>
 * Samuel Ortiz <samuel.ortiz@intel.com>
 * Zhu Yi <yi.zhu@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.
 *
 */

#include <linux/rfkill.h>

#include "iwm.h"

static int iwm_rfkill_soft_toggle(void *data, enum rfkill_state state)
{
	struct iwm_priv *iwm = data;

	switch (state) {
	case RFKILL_STATE_UNBLOCKED:
		if (test_bit(IWM_RADIO_RFKILL_HW, &iwm->radio))
			return -EBUSY;

		if (test_and_clear_bit(IWM_RADIO_RFKILL_SW, &iwm->radio) &&
		    (iwm_to_ndev(iwm)->flags & IFF_UP))
			iwm_up(iwm);

		break;
	case RFKILL_STATE_SOFT_BLOCKED:
		if (!test_and_set_bit(IWM_RADIO_RFKILL_SW, &iwm->radio))
			iwm_down(iwm);

		break;
	default:
		break;
	}

	return 0;
}

int iwm_rfkill_init(struct iwm_priv *iwm)
{
	int ret;

	iwm->rfkill = rfkill_allocate(iwm_to_dev(iwm), RFKILL_TYPE_WLAN);
	if (!iwm->rfkill) {
		IWM_ERR(iwm, "Unable to allocate rfkill device\n");
		return -ENOMEM;
	}

	iwm->rfkill->name = KBUILD_MODNAME;
	iwm->rfkill->data = iwm;
	iwm->rfkill->state = RFKILL_STATE_UNBLOCKED;
	iwm->rfkill->toggle_radio = iwm_rfkill_soft_toggle;

	ret = rfkill_register(iwm->rfkill);
	if (ret) {
		IWM_ERR(iwm, "Failed to register rfkill device\n");
		goto fail;
	}

	return 0;
 fail:
	rfkill_free(iwm->rfkill);
	return ret;
}

void iwm_rfkill_exit(struct iwm_priv *iwm)
{
	if (iwm->rfkill)
		rfkill_unregister(iwm->rfkill);

	rfkill_free(iwm->rfkill);
	iwm->rfkill = NULL;
}