drivers/net/wireless/iwlegacy/iwl-4965-led.c

   1 /******************************************************************************
   2  *
   3  * Copyright(c) 2003 - 2011 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 <net/mac80211.h>
  36 #include <linux/etherdevice.h>
  37 #include <asm/unaligned.h>
  38
  39 #include "iwl-commands.h"
  40 #include "iwl-dev.h"
  41 #include "iwl-core.h"
  42 #include "iwl-io.h"
  43 #include "iwl-4965-led.h"
  44
  45 /* Send led command */
  46 static int
  47 iwl4965_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_legacy_send_cmd(priv, &cmd);
  63 }
  64
  65 /* Set led register off */
  66 void iwl4965_led_enable(struct iwl_priv *priv)
  67 {
  68         iwl_write32(priv, CSR_LED_REG, CSR_LED_REG_TRUN_ON);
  69 }
  70
  71 const struct iwl_led_ops iwl4965_led_ops = {
  72         .cmd = iwl4965_send_led_cmd,
  73 };