drivers/net/wireless/iwlwifi/iwl-agn-led.c

   1 /******************************************************************************
   2  *
   3  * Copyright(c) 2003 - 2010 Intel Corporation. All rights reserved.
   4  *
   5  * This program is free software; you can redistribute it and/or modify it
   6  * under the terms of version 2 of the GNU General Public License as
   7  * published by the Free Software Foundation.
   8  *
   9  * This program is distributed in the hope that it will be useful, but WITHOUT
  10  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  11  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  12  * more details.
  13  *
  14  * You should have received a copy of the GNU General Public License along with
  15  * this program; if not, write to the Free Software Foundation, Inc.,
  16  * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
  17  *
  18  * The full GNU General Public License is included in this distribution in the
  19  * file called LICENSE.
  20  *
  21  * Contact Information:
  22  *  Intel Linux Wireless <ilw@linux.intel.com>
  23  * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
  24  *
  25  *****************************************************************************/
  26
  27 #include <linux/kernel.h>
  28 #include <linux/module.h>
  29 #include <linux/init.h>
  30 #include <linux/pci.h>
  31 #include <linux/dma-mapping.h>
  32 #include <linux/delay.h>
  33 #include <linux/skbuff.h>
  34 #include <linux/netdevice.h>
  35 #include <linux/wireless.h>
  36 #include <net/mac80211.h>
  37 #include <linux/etherdevice.h>
  38 #include <asm/unaligned.h>
  39
  40 #include "iwl-commands.h"
  41 #include "iwl-dev.h"
  42 #include "iwl-core.h"
  43 #include "iwl-io.h"
  44 #include "iwl-agn-led.h"
  45
  46 /* Send led command */
  47 static int iwl_send_led_cmd(struct iwl_priv *priv, struct iwl_led_cmd *led_cmd)
  48 {
  49         struct iwl_host_cmd cmd = {
  50                 .id = REPLY_LEDS_CMD,
  51                 .len = sizeof(struct iwl_led_cmd),
  52                 .data = led_cmd,
  53                 .flags = CMD_ASYNC,
  54                 .callback = NULL,
  55         };
  56         u32 reg;
  57
  58         reg = iwl_read32(priv, CSR_LED_REG);
  59         if (reg != (reg & CSR_LED_BSM_CTRL_MSK))
  60                 iwl_write32(priv, CSR_LED_REG, reg & CSR_LED_BSM_CTRL_MSK);
  61
  62         return iwl_send_cmd(priv, &cmd);
  63 }
  64
  65 /* Set led register off */
  66 static int iwl_led_on_reg(struct iwl_priv *priv)
  67 {
  68         IWL_DEBUG_LED(priv, "led on\n");
  69         iwl_write32(priv, CSR_LED_REG, CSR_LED_REG_TRUN_ON);
  70         return 0;
  71 }
  72
  73 /* Set led register off */
  74 static int iwl_led_off_reg(struct iwl_priv *priv)
  75 {
  76         IWL_DEBUG_LED(priv, "LED Reg off\n");
  77         iwl_write32(priv, CSR_LED_REG, CSR_LED_REG_TRUN_OFF);
  78         return 0;
  79 }
  80
  81 const struct iwl_led_ops iwlagn_led_ops = {
  82         .cmd = iwl_send_led_cmd,
  83         .on = iwl_led_on_reg,
  84         .off = iwl_led_off_reg,
  85 };