rt2870_led.c

   1
   2 /*-
   3  * Copyright (c) 2009-2010 Alexander Egorenkov <egorenar@gmail.com>
   4  * Copyright (c) 2009 Damien Bergamini <damien.bergamini@free.fr>
   5  *
   6  * Permission to use, copy, modify, and distribute this software for any
   7  * purpose with or without fee is hereby granted, provided that the above
   8  * copyright notice and this permission notice appear in all copies.
   9  *
  10  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
  11  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  12  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  13  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  14  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  15  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  16  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  17  */
  18
  19 #include "rt2870_led.h"
  20 #include "rt2870_reg.h"
  21 #include "rt2870_eeprom.h"
  22 #include "rt2870_io.h"
  23
  24 /*
  25  * rt2870_led_brightness
  26  */
  27 void rt2870_led_brightness(struct rt2870_softc *sc, uint8_t brightness)
  28 {
  29         uint8_t polarity;
  30         uint16_t tmp;
  31
  32         polarity = (sc->led_cntl & RT2870_EEPROM_LED_POLARITY) ? 1 : 0;
  33
  34         tmp = (polarity << 8) | brightness;
  35
  36         rt2870_io_mcu_cmd(sc, RT2870_IO_MCU_CMD_LED_BRIGHTNESS,
  37                 RT2870_REG_H2M_TOKEN_NO_INTR, tmp);
  38 }
  39
  40 /*
  41  * rt2870_led_cmd
  42  */
  43 void rt2870_led_cmd(struct rt2870_softc *sc, uint8_t cmd)
  44 {
  45         uint16_t tmp;
  46
  47         tmp = (cmd << 8) | (sc->led_cntl & RT2870_EEPROM_LED_MODE_MASK);
  48
  49         rt2870_io_mcu_cmd(sc, RT2870_IO_MCU_CMD_LEDS,
  50                 RT2870_REG_H2M_TOKEN_NO_INTR, tmp);
  51 }