drivers/staging/rtl8188eu/hal/rtl8188eu_led.c

   1 /******************************************************************************
   2  *
   3  * Copyright(c) 2007 - 2011 Realtek 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  ******************************************************************************/
  15
  16 #include <osdep_service.h>
  17 #include <drv_types.h>
  18 #include <rtl8188e_hal.h>
  19 #include <rtl8188e_led.h>
  20 #include <usb_ops_linux.h>
  21
  22 /*  LED object. */
  23
  24 /*  LED_819xUsb routines. */
  25 /*      Description: */
  26 /*              Turn on LED according to LedPin specified. */
  27 void SwLedOn(struct adapter *padapter, struct LED_871x *pLed)
  28 {
  29         u8      LedCfg;
  30
  31         if (padapter->bSurpriseRemoved || padapter->bDriverStopped)
  32                 return;
  33         LedCfg = usb_read8(padapter, REG_LEDCFG2);
  34         usb_write8(padapter, REG_LEDCFG2, (LedCfg&0xf0) | BIT(5) | BIT(6)); /*  SW control led0 on. */
  35         pLed->bLedOn = true;
  36 }
  37
  38 /*      Description: */
  39 /*              Turn off LED according to LedPin specified. */
  40 void SwLedOff(struct adapter *padapter, struct LED_871x *pLed)
  41 {
  42         u8      LedCfg;
  43
  44         if (padapter->bSurpriseRemoved || padapter->bDriverStopped)
  45                 goto exit;
  46
  47         LedCfg = usb_read8(padapter, REG_LEDCFG2);/* 0x4E */
  48
  49         if (padapter->HalData->bLedOpenDrain) {
  50                         /*  Open-drain arrangement for controlling the LED) */
  51                 LedCfg &= 0x90; /*  Set to software control. */
  52                 usb_write8(padapter, REG_LEDCFG2, (LedCfg | BIT(3)));
  53                 LedCfg = usb_read8(padapter, REG_MAC_PINMUX_CFG);
  54                 LedCfg &= 0xFE;
  55                 usb_write8(padapter, REG_MAC_PINMUX_CFG, LedCfg);
  56         } else {
  57                 usb_write8(padapter, REG_LEDCFG2, (LedCfg | BIT(3) | BIT(5) | BIT(6)));
  58         }
  59 exit:
  60         pLed->bLedOn = false;
  61 }
  62
  63 /*  Interface to manipulate LED objects. */
  64 /*  Default LED behavior. */
  65
  66 /*      Description: */
  67 /*              Initialize all LED_871x objects. */
  68 void rtw_hal_sw_led_init(struct adapter *padapter)
  69 {
  70         struct led_priv *pledpriv = &(padapter->ledpriv);
  71
  72         pledpriv->bRegUseLed = true;
  73         pledpriv->LedControlHandler = LedControl8188eu;
  74         padapter->HalData->bLedOpenDrain = true;
  75
  76         InitLed871x(padapter, &(pledpriv->SwLed0));
  77 }
  78
  79 /*      Description: */
  80 /*              DeInitialize all LED_819xUsb objects. */
  81 void rtw_hal_sw_led_deinit(struct adapter *padapter)
  82 {
  83         struct led_priv *ledpriv = &(padapter->ledpriv);
  84
  85         DeInitLed871x(&(ledpriv->SwLed0));
  86 }