Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 1 | #include "headers.h" |
| 2 | |
| 3 | #define STATUS_IMAGE_CHECKSUM_MISMATCH -199 |
| 4 | #define EVENT_SIGNALED 1 |
| 5 | |
| 6 | static B_UINT16 CFG_CalculateChecksum(B_UINT8 *pu8Buffer, B_UINT32 u32Size) |
| 7 | { |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 8 | B_UINT16 u16CheckSum = 0; |
| 9 | while (u32Size--) { |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 10 | u16CheckSum += (B_UINT8)~(*pu8Buffer); |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 11 | pu8Buffer++; |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 12 | } |
| 13 | return u16CheckSum; |
| 14 | } |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 15 | |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 16 | BOOLEAN IsReqGpioIsLedInNVM(PMINI_ADAPTER Adapter, UINT gpios) |
| 17 | { |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 18 | INT Status; |
| 19 | Status = (Adapter->gpioBitMap & gpios) ^ gpios; |
| 20 | if (Status) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 21 | return FALSE; |
| 22 | else |
| 23 | return TRUE; |
| 24 | } |
| 25 | |
Arnd Bergmann | 44a17eff | 2010-09-30 10:24:12 +0200 | [diff] [blame] | 26 | static INT LED_Blink(PMINI_ADAPTER Adapter, UINT GPIO_Num, UCHAR uiLedIndex, ULONG timeout, INT num_of_time, LedEventInfo_t currdriverstate) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 27 | { |
| 28 | int Status = STATUS_SUCCESS; |
| 29 | BOOLEAN bInfinite = FALSE; |
| 30 | |
| 31 | /*Check if num_of_time is -ve. If yes, blink led in infinite loop*/ |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 32 | if (num_of_time < 0) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 33 | { |
| 34 | bInfinite = TRUE; |
| 35 | num_of_time = 1; |
| 36 | } |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 37 | while (num_of_time) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 38 | { |
| 39 | |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 40 | if (currdriverstate == Adapter->DriverState) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 41 | TURN_ON_LED(GPIO_Num, uiLedIndex); |
| 42 | |
| 43 | /*Wait for timeout after setting on the LED*/ |
| 44 | Status = wait_event_interruptible_timeout(Adapter->LEDInfo.notify_led_event, |
| 45 | currdriverstate != Adapter->DriverState || kthread_should_stop(), |
| 46 | msecs_to_jiffies(timeout)); |
| 47 | |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 48 | if (kthread_should_stop()) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 49 | { |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 50 | BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, LED_DUMP_INFO, DBG_LVL_ALL, "Led thread got signal to exit..hence exiting"); |
| 51 | Adapter->LEDInfo.led_thread_running = BCM_LED_THREAD_DISABLED; |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 52 | TURN_OFF_LED(GPIO_Num, uiLedIndex); |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 53 | Status = EVENT_SIGNALED; |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 54 | break; |
| 55 | } |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 56 | if (Status) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 57 | { |
| 58 | TURN_OFF_LED(GPIO_Num, uiLedIndex); |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 59 | Status = EVENT_SIGNALED; |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 60 | break; |
| 61 | } |
| 62 | |
| 63 | TURN_OFF_LED(GPIO_Num, uiLedIndex); |
| 64 | Status = wait_event_interruptible_timeout(Adapter->LEDInfo.notify_led_event, |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 65 | currdriverstate != Adapter->DriverState || kthread_should_stop(), |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 66 | msecs_to_jiffies(timeout)); |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 67 | if (bInfinite == FALSE) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 68 | num_of_time--; |
| 69 | } |
| 70 | return Status; |
| 71 | } |
| 72 | |
Arnd Bergmann | 44a17eff | 2010-09-30 10:24:12 +0200 | [diff] [blame] | 73 | static INT ScaleRateofTransfer(ULONG rate) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 74 | { |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 75 | if (rate <= 3) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 76 | return rate; |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 77 | else if ((rate > 3) && (rate <= 100)) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 78 | return 5; |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 79 | else if ((rate > 100) && (rate <= 200)) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 80 | return 6; |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 81 | else if ((rate > 200) && (rate <= 300)) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 82 | return 7; |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 83 | else if ((rate > 300) && (rate <= 400)) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 84 | return 8; |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 85 | else if ((rate > 400) && (rate <= 500)) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 86 | return 9; |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 87 | else if ((rate > 500) && (rate <= 600)) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 88 | return 10; |
| 89 | else |
| 90 | return MAX_NUM_OF_BLINKS; |
| 91 | } |
| 92 | |
| 93 | |
| 94 | |
Arnd Bergmann | 44a17eff | 2010-09-30 10:24:12 +0200 | [diff] [blame] | 95 | static INT LED_Proportional_Blink(PMINI_ADAPTER Adapter, UCHAR GPIO_Num_tx, |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 96 | UCHAR uiTxLedIndex, UCHAR GPIO_Num_rx, UCHAR uiRxLedIndex, LedEventInfo_t currdriverstate) |
| 97 | { |
| 98 | /* Initial values of TX and RX packets*/ |
| 99 | ULONG64 Initial_num_of_packts_tx = 0, Initial_num_of_packts_rx = 0; |
| 100 | /*values of TX and RX packets after 1 sec*/ |
| 101 | ULONG64 Final_num_of_packts_tx = 0, Final_num_of_packts_rx = 0; |
| 102 | /*Rate of transfer of Tx and Rx in 1 sec*/ |
| 103 | ULONG64 rate_of_transfer_tx = 0, rate_of_transfer_rx = 0; |
| 104 | int Status = STATUS_SUCCESS; |
| 105 | INT num_of_time = 0, num_of_time_tx = 0, num_of_time_rx = 0; |
| 106 | UINT remDelay = 0; |
| 107 | BOOLEAN bBlinkBothLED = TRUE; |
| 108 | //UINT GPIO_num = DISABLE_GPIO_NUM; |
| 109 | ulong timeout = 0; |
| 110 | |
| 111 | /*Read initial value of packets sent/received */ |
Stephen Hemminger | cacd922 | 2010-11-01 13:34:35 -0400 | [diff] [blame] | 112 | Initial_num_of_packts_tx = Adapter->dev->stats.tx_packets; |
| 113 | Initial_num_of_packts_rx = Adapter->dev->stats.rx_packets; |
| 114 | |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 115 | /*Scale the rate of transfer to no of blinks.*/ |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 116 | num_of_time_tx = ScaleRateofTransfer((ULONG)rate_of_transfer_tx); |
| 117 | num_of_time_rx = ScaleRateofTransfer((ULONG)rate_of_transfer_rx); |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 118 | |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 119 | while ((Adapter->device_removed == FALSE)) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 120 | { |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 121 | timeout = 50; |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 122 | /*Blink Tx and Rx LED when both Tx and Rx is in normal bandwidth*/ |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 123 | if (bBlinkBothLED) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 124 | { |
| 125 | /*Assign minimum number of blinks of either Tx or Rx.*/ |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 126 | if (num_of_time_tx > num_of_time_rx) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 127 | num_of_time = num_of_time_rx; |
| 128 | else |
| 129 | num_of_time = num_of_time_tx; |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 130 | if (num_of_time > 0) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 131 | { |
| 132 | /*Blink both Tx and Rx LEDs*/ |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 133 | if (LED_Blink(Adapter, 1 << GPIO_Num_tx, uiTxLedIndex, timeout, num_of_time, currdriverstate) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 134 | == EVENT_SIGNALED) |
| 135 | { |
| 136 | return EVENT_SIGNALED; |
| 137 | } |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 138 | if (LED_Blink(Adapter, 1 << GPIO_Num_rx, uiRxLedIndex, timeout, num_of_time, currdriverstate) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 139 | == EVENT_SIGNALED) |
| 140 | { |
| 141 | return EVENT_SIGNALED; |
| 142 | } |
| 143 | |
| 144 | } |
| 145 | |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 146 | if (num_of_time == num_of_time_tx) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 147 | { |
| 148 | /*Blink pending rate of Rx*/ |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 149 | if (LED_Blink(Adapter, (1 << GPIO_Num_rx), uiRxLedIndex, timeout, |
| 150 | num_of_time_rx-num_of_time, currdriverstate) == EVENT_SIGNALED) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 151 | { |
| 152 | return EVENT_SIGNALED; |
| 153 | } |
| 154 | num_of_time = num_of_time_rx; |
| 155 | } |
| 156 | else |
| 157 | { |
| 158 | /*Blink pending rate of Tx*/ |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 159 | if (LED_Blink(Adapter, 1 << GPIO_Num_tx, uiTxLedIndex, timeout, |
| 160 | num_of_time_tx-num_of_time, currdriverstate) == EVENT_SIGNALED) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 161 | { |
| 162 | return EVENT_SIGNALED; |
| 163 | } |
| 164 | num_of_time = num_of_time_tx; |
| 165 | } |
| 166 | } |
| 167 | else |
| 168 | { |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 169 | if (num_of_time == num_of_time_tx) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 170 | { |
| 171 | /*Blink pending rate of Rx*/ |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 172 | if (LED_Blink(Adapter, 1 << GPIO_Num_tx, uiTxLedIndex, timeout, num_of_time, currdriverstate) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 173 | == EVENT_SIGNALED) |
| 174 | { |
| 175 | return EVENT_SIGNALED; |
| 176 | } |
| 177 | } |
| 178 | else |
| 179 | { |
| 180 | /*Blink pending rate of Tx*/ |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 181 | if (LED_Blink(Adapter, 1 << GPIO_Num_rx, uiRxLedIndex, timeout, |
| 182 | num_of_time, currdriverstate) == EVENT_SIGNALED) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 183 | { |
| 184 | return EVENT_SIGNALED; |
| 185 | } |
| 186 | } |
| 187 | } |
| 188 | /* If Tx/Rx rate is less than maximum blinks per second, |
| 189 | * wait till delay completes to 1 second |
| 190 | */ |
| 191 | remDelay = MAX_NUM_OF_BLINKS - num_of_time; |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 192 | if (remDelay > 0) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 193 | { |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 194 | timeout = 100 * remDelay; |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 195 | Status = wait_event_interruptible_timeout(Adapter->LEDInfo.notify_led_event, |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 196 | currdriverstate != Adapter->DriverState || kthread_should_stop(), |
| 197 | msecs_to_jiffies(timeout)); |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 198 | |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 199 | if (kthread_should_stop()) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 200 | { |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 201 | BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, LED_DUMP_INFO, DBG_LVL_ALL, "Led thread got signal to exit..hence exiting"); |
| 202 | Adapter->LEDInfo.led_thread_running = BCM_LED_THREAD_DISABLED; |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 203 | return EVENT_SIGNALED; |
| 204 | } |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 205 | if (Status) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 206 | return EVENT_SIGNALED; |
| 207 | } |
| 208 | |
| 209 | /*Turn off both Tx and Rx LEDs before next second*/ |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 210 | TURN_OFF_LED(1 << GPIO_Num_tx, uiTxLedIndex); |
| 211 | TURN_OFF_LED(1 << GPIO_Num_rx, uiTxLedIndex); |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 212 | |
| 213 | /* |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 214 | * Read the Tx & Rx packets transmission after 1 second and |
| 215 | * calculate rate of transfer |
| 216 | */ |
Stephen Hemminger | cacd922 | 2010-11-01 13:34:35 -0400 | [diff] [blame] | 217 | Final_num_of_packts_tx = Adapter->dev->stats.tx_packets; |
| 218 | Final_num_of_packts_rx = Adapter->dev->stats.rx_packets; |
| 219 | |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 220 | rate_of_transfer_tx = Final_num_of_packts_tx - Initial_num_of_packts_tx; |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 221 | rate_of_transfer_rx = Final_num_of_packts_rx - Initial_num_of_packts_rx; |
| 222 | |
| 223 | /*Read initial value of packets sent/received */ |
| 224 | Initial_num_of_packts_tx = Final_num_of_packts_tx; |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 225 | Initial_num_of_packts_rx = Final_num_of_packts_rx; |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 226 | |
| 227 | /*Scale the rate of transfer to no of blinks.*/ |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 228 | num_of_time_tx = ScaleRateofTransfer((ULONG)rate_of_transfer_tx); |
| 229 | num_of_time_rx = ScaleRateofTransfer((ULONG)rate_of_transfer_rx); |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 230 | |
| 231 | } |
| 232 | return Status; |
| 233 | } |
| 234 | |
| 235 | |
| 236 | //----------------------------------------------------------------------------- |
| 237 | // Procedure: ValidateDSDParamsChecksum |
| 238 | // |
| 239 | // Description: Reads DSD Params and validates checkusm. |
| 240 | // |
| 241 | // Arguments: |
| 242 | // Adapter - Pointer to Adapter structure. |
| 243 | // ulParamOffset - Start offset of the DSD parameter to be read and validated. |
| 244 | // usParamLen - Length of the DSD Parameter. |
| 245 | // |
| 246 | // Returns: |
| 247 | // <OSAL_STATUS_CODE> |
| 248 | //----------------------------------------------------------------------------- |
| 249 | |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 250 | static INT ValidateDSDParamsChecksum(PMINI_ADAPTER Adapter, ULONG ulParamOffset, USHORT usParamLen) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 251 | { |
| 252 | INT Status = STATUS_SUCCESS; |
Johannes Tenschert | 34e98e7 | 2011-12-07 18:25:07 +0100 | [diff] [blame^] | 253 | PUCHAR puBuffer = NULL; |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 254 | USHORT usChksmOrg = 0; |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 255 | USHORT usChecksumCalculated = 0; |
| 256 | |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 257 | BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, LED_DUMP_INFO, DBG_LVL_ALL, "LED Thread:ValidateDSDParamsChecksum: 0x%lx 0x%X", ulParamOffset, usParamLen); |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 258 | |
Stephen Hemminger | 082e889 | 2010-11-01 09:35:21 -0400 | [diff] [blame] | 259 | puBuffer = kmalloc(usParamLen, GFP_KERNEL); |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 260 | if (!puBuffer) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 261 | { |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 262 | BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, LED_DUMP_INFO, DBG_LVL_ALL, "LED Thread: ValidateDSDParamsChecksum Allocation failed"); |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 263 | return -ENOMEM; |
| 264 | |
| 265 | } |
| 266 | |
| 267 | // |
| 268 | // Read the DSD data from the parameter offset. |
| 269 | // |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 270 | if (STATUS_SUCCESS != BeceemNVMRead(Adapter, (PUINT)puBuffer, ulParamOffset, usParamLen)) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 271 | { |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 272 | BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, LED_DUMP_INFO, DBG_LVL_ALL, "LED Thread: ValidateDSDParamsChecksum BeceemNVMRead failed"); |
| 273 | Status = STATUS_IMAGE_CHECKSUM_MISMATCH; |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 274 | goto exit; |
| 275 | } |
| 276 | |
| 277 | // |
| 278 | // Calculate the checksum of the data read from the DSD parameter. |
| 279 | // |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 280 | usChecksumCalculated = CFG_CalculateChecksum(puBuffer, usParamLen); |
| 281 | BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, LED_DUMP_INFO, DBG_LVL_ALL, "LED Thread: usCheckSumCalculated = 0x%x\n", usChecksumCalculated); |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 282 | |
| 283 | // |
| 284 | // End of the DSD parameter will have a TWO bytes checksum stored in it. Read it and compare with the calculated |
| 285 | // Checksum. |
| 286 | // |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 287 | if (STATUS_SUCCESS != BeceemNVMRead(Adapter, (PUINT)&usChksmOrg, ulParamOffset+usParamLen, 2)) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 288 | { |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 289 | BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, LED_DUMP_INFO, DBG_LVL_ALL, "LED Thread: ValidateDSDParamsChecksum BeceemNVMRead failed"); |
| 290 | Status = STATUS_IMAGE_CHECKSUM_MISMATCH; |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 291 | goto exit; |
| 292 | } |
| 293 | usChksmOrg = ntohs(usChksmOrg); |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 294 | BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, LED_DUMP_INFO, DBG_LVL_ALL, "LED Thread: usChksmOrg = 0x%x", usChksmOrg); |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 295 | |
| 296 | // |
| 297 | // Compare the checksum calculated with the checksum read from DSD section |
| 298 | // |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 299 | if (usChecksumCalculated ^ usChksmOrg) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 300 | { |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 301 | BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, LED_DUMP_INFO, DBG_LVL_ALL, "LED Thread: ValidateDSDParamsChecksum: Checksums don't match"); |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 302 | Status = STATUS_IMAGE_CHECKSUM_MISMATCH; |
| 303 | goto exit; |
| 304 | } |
| 305 | |
| 306 | exit: |
Stephen Hemminger | 082e889 | 2010-11-01 09:35:21 -0400 | [diff] [blame] | 307 | kfree(puBuffer); |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 308 | return Status; |
| 309 | } |
| 310 | |
| 311 | |
| 312 | //----------------------------------------------------------------------------- |
| 313 | // Procedure: ValidateHWParmStructure |
| 314 | // |
| 315 | // Description: Validates HW Parameters. |
| 316 | // |
| 317 | // Arguments: |
| 318 | // Adapter - Pointer to Adapter structure. |
| 319 | // ulHwParamOffset - Start offset of the HW parameter Section to be read and validated. |
| 320 | // |
| 321 | // Returns: |
| 322 | // <OSAL_STATUS_CODE> |
| 323 | //----------------------------------------------------------------------------- |
| 324 | |
Arnd Bergmann | 44a17eff | 2010-09-30 10:24:12 +0200 | [diff] [blame] | 325 | static INT ValidateHWParmStructure(PMINI_ADAPTER Adapter, ULONG ulHwParamOffset) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 326 | { |
| 327 | |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 328 | INT Status = STATUS_SUCCESS; |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 329 | USHORT HwParamLen = 0; |
| 330 | // Add DSD start offset to the hwParamOffset to get the actual address. |
| 331 | ulHwParamOffset += DSD_START_OFFSET; |
| 332 | |
| 333 | /*Read the Length of HW_PARAM structure*/ |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 334 | BeceemNVMRead(Adapter, (PUINT)&HwParamLen, ulHwParamOffset, 2); |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 335 | HwParamLen = ntohs(HwParamLen); |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 336 | if (0 == HwParamLen || HwParamLen > Adapter->uiNVMDSDSize) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 337 | { |
| 338 | return STATUS_IMAGE_CHECKSUM_MISMATCH; |
| 339 | } |
| 340 | |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 341 | BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, LED_DUMP_INFO, DBG_LVL_ALL, "LED Thread:HwParamLen = 0x%x", HwParamLen); |
| 342 | Status = ValidateDSDParamsChecksum(Adapter, ulHwParamOffset, HwParamLen); |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 343 | return Status; |
| 344 | } /* ValidateHWParmStructure() */ |
| 345 | |
Arnd Bergmann | 44a17eff | 2010-09-30 10:24:12 +0200 | [diff] [blame] | 346 | static int ReadLEDInformationFromEEPROM(PMINI_ADAPTER Adapter, UCHAR GPIO_Array[]) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 347 | { |
| 348 | int Status = STATUS_SUCCESS; |
| 349 | |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 350 | ULONG dwReadValue = 0; |
| 351 | USHORT usHwParamData = 0; |
| 352 | USHORT usEEPROMVersion = 0; |
| 353 | UCHAR ucIndex = 0; |
| 354 | UCHAR ucGPIOInfo[32] = {0}; |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 355 | |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 356 | BeceemNVMRead(Adapter, (PUINT)&usEEPROMVersion, EEPROM_VERSION_OFFSET, 2); |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 357 | |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 358 | BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, LED_DUMP_INFO, DBG_LVL_ALL, "usEEPROMVersion: Minor:0x%X Major:0x%x", usEEPROMVersion&0xFF, ((usEEPROMVersion>>8)&0xFF)); |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 359 | |
| 360 | |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 361 | if (((usEEPROMVersion>>8)&0xFF) < EEPROM_MAP5_MAJORVERSION) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 362 | { |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 363 | BeceemNVMRead(Adapter, (PUINT)&usHwParamData, EEPROM_HW_PARAM_POINTER_ADDRESS, 2); |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 364 | usHwParamData = ntohs(usHwParamData); |
| 365 | dwReadValue = usHwParamData; |
| 366 | } |
| 367 | else |
| 368 | { |
| 369 | // |
| 370 | // Validate Compatibility section and then read HW param if compatibility section is valid. |
| 371 | // |
| 372 | Status = ValidateDSDParamsChecksum(Adapter, |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 373 | DSD_START_OFFSET, |
| 374 | COMPATIBILITY_SECTION_LENGTH_MAP5); |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 375 | |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 376 | if (Status != STATUS_SUCCESS) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 377 | { |
| 378 | return Status; |
| 379 | } |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 380 | BeceemNVMRead(Adapter, (PUINT)&dwReadValue, EEPROM_HW_PARAM_POINTER_ADDRRES_MAP5, 4); |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 381 | dwReadValue = ntohl(dwReadValue); |
| 382 | } |
| 383 | |
| 384 | |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 385 | BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, LED_DUMP_INFO, DBG_LVL_ALL, "LED Thread: Start address of HW_PARAM structure = 0x%lx", dwReadValue); |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 386 | |
| 387 | // |
| 388 | // Validate if the address read out is within the DSD. |
| 389 | // Adapter->uiNVMDSDSize gives whole DSD size inclusive of Autoinit. |
| 390 | // lower limit should be above DSD_START_OFFSET and |
| 391 | // upper limit should be below (Adapter->uiNVMDSDSize-DSD_START_OFFSET) |
| 392 | // |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 393 | if (dwReadValue < DSD_START_OFFSET || |
| 394 | dwReadValue > (Adapter->uiNVMDSDSize-DSD_START_OFFSET)) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 395 | { |
| 396 | return STATUS_IMAGE_CHECKSUM_MISMATCH; |
| 397 | } |
| 398 | |
| 399 | Status = ValidateHWParmStructure(Adapter, dwReadValue); |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 400 | if (Status) { |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 401 | return Status; |
| 402 | } |
| 403 | |
| 404 | /* |
| 405 | Add DSD_START_OFFSET to the offset read from the EEPROM. |
| 406 | This will give the actual start HW Parameters start address. |
| 407 | To read GPIO section, add GPIO offset further. |
| 408 | */ |
| 409 | |
| 410 | dwReadValue += DSD_START_OFFSET; // = start address of hw param section. |
| 411 | dwReadValue += GPIO_SECTION_START_OFFSET; // = GPIO start offset within HW Param section. |
| 412 | |
| 413 | /* Read the GPIO values for 32 GPIOs from EEPROM and map the function |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 414 | * number to GPIO pin number to GPIO_Array |
| 415 | */ |
| 416 | BeceemNVMRead(Adapter, (UINT *)ucGPIOInfo, dwReadValue, 32); |
| 417 | for (ucIndex = 0; ucIndex < 32; ucIndex++) |
| 418 | { |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 419 | |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 420 | switch (ucGPIOInfo[ucIndex]) |
Johannes Tenschert | 34e98e7 | 2011-12-07 18:25:07 +0100 | [diff] [blame^] | 421 | { |
| 422 | case RED_LED: |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 423 | { |
Johannes Tenschert | 34e98e7 | 2011-12-07 18:25:07 +0100 | [diff] [blame^] | 424 | GPIO_Array[RED_LED] = ucIndex; |
| 425 | Adapter->gpioBitMap |= (1 << ucIndex); |
| 426 | break; |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 427 | } |
Johannes Tenschert | 34e98e7 | 2011-12-07 18:25:07 +0100 | [diff] [blame^] | 428 | case BLUE_LED: |
| 429 | { |
| 430 | GPIO_Array[BLUE_LED] = ucIndex; |
| 431 | Adapter->gpioBitMap |= (1 << ucIndex); |
| 432 | break; |
| 433 | } |
| 434 | case YELLOW_LED: |
| 435 | { |
| 436 | GPIO_Array[YELLOW_LED] = ucIndex; |
| 437 | Adapter->gpioBitMap |= (1 << ucIndex); |
| 438 | break; |
| 439 | } |
| 440 | case GREEN_LED: |
| 441 | { |
| 442 | GPIO_Array[GREEN_LED] = ucIndex; |
| 443 | Adapter->gpioBitMap |= (1 << ucIndex); |
| 444 | break; |
| 445 | } |
| 446 | default: |
| 447 | break; |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 448 | } |
Johannes Tenschert | 34e98e7 | 2011-12-07 18:25:07 +0100 | [diff] [blame^] | 449 | |
| 450 | } |
| 451 | BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, LED_DUMP_INFO, DBG_LVL_ALL, "GPIO's bit map correspond to LED :0x%X", Adapter->gpioBitMap); |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 452 | return Status; |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 453 | } |
| 454 | |
| 455 | |
Arnd Bergmann | 44a17eff | 2010-09-30 10:24:12 +0200 | [diff] [blame] | 456 | static int ReadConfigFileStructure(PMINI_ADAPTER Adapter, BOOLEAN *bEnableThread) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 457 | { |
| 458 | int Status = STATUS_SUCCESS; |
| 459 | UCHAR GPIO_Array[NUM_OF_LEDS+1]; /*Array to store GPIO numbers from EEPROM*/ |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 460 | UINT uiIndex = 0; |
| 461 | UINT uiNum_of_LED_Type = 0; |
| 462 | PUCHAR puCFGData = NULL; |
| 463 | UCHAR bData = 0; |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 464 | memset(GPIO_Array, DISABLE_GPIO_NUM, NUM_OF_LEDS+1); |
| 465 | |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 466 | if (!Adapter->pstargetparams || IS_ERR(Adapter->pstargetparams)) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 467 | { |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 468 | BCM_DEBUG_PRINT (Adapter, DBG_TYPE_OTHERS, LED_DUMP_INFO, DBG_LVL_ALL, "Target Params not Avail.\n"); |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 469 | return -ENOENT; |
| 470 | } |
| 471 | |
| 472 | /*Populate GPIO_Array with GPIO numbers for LED functions*/ |
| 473 | /*Read the GPIO numbers from EEPROM*/ |
| 474 | Status = ReadLEDInformationFromEEPROM(Adapter, GPIO_Array); |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 475 | if (Status == STATUS_IMAGE_CHECKSUM_MISMATCH) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 476 | { |
| 477 | *bEnableThread = FALSE; |
| 478 | return STATUS_SUCCESS; |
| 479 | } |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 480 | else if (Status) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 481 | { |
| 482 | *bEnableThread = FALSE; |
| 483 | return Status; |
| 484 | } |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 485 | /* |
| 486 | * CONFIG file read successfully. Deallocate the memory of |
| 487 | * uiFileNameBufferSize |
| 488 | */ |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 489 | BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, LED_DUMP_INFO, DBG_LVL_ALL, "LED Thread: Config file read successfully\n"); |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 490 | puCFGData = (PUCHAR) &Adapter->pstargetparams->HostDrvrConfig1; |
| 491 | |
| 492 | /* |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 493 | * Offset for HostDrvConfig1, HostDrvConfig2, HostDrvConfig3 which |
| 494 | * will have the information of LED type, LED on state for different |
| 495 | * driver state and LED blink state. |
| 496 | */ |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 497 | |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 498 | for (uiIndex = 0; uiIndex < NUM_OF_LEDS; uiIndex++) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 499 | { |
| 500 | bData = *puCFGData; |
| 501 | |
| 502 | /*Check Bit 8 for polarity. If it is set, polarity is reverse polarity*/ |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 503 | if (bData & 0x80) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 504 | { |
| 505 | Adapter->LEDInfo.LEDState[uiIndex].BitPolarity = 0; |
| 506 | /*unset the bit 8*/ |
| 507 | bData = bData & 0x7f; |
| 508 | } |
| 509 | |
| 510 | Adapter->LEDInfo.LEDState[uiIndex].LED_Type = bData; |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 511 | if (bData <= NUM_OF_LEDS) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 512 | Adapter->LEDInfo.LEDState[uiIndex].GPIO_Num = GPIO_Array[bData]; |
| 513 | else |
| 514 | Adapter->LEDInfo.LEDState[uiIndex].GPIO_Num = DISABLE_GPIO_NUM; |
| 515 | |
| 516 | puCFGData++; |
| 517 | bData = *puCFGData; |
| 518 | Adapter->LEDInfo.LEDState[uiIndex].LED_On_State = bData; |
| 519 | puCFGData++; |
| 520 | bData = *puCFGData; |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 521 | Adapter->LEDInfo.LEDState[uiIndex].LED_Blink_State = bData; |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 522 | puCFGData++; |
| 523 | } |
| 524 | |
| 525 | /*Check if all the LED settings are disabled. If it is disabled, dont launch the LED control thread.*/ |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 526 | for (uiIndex = 0; uiIndex < NUM_OF_LEDS; uiIndex++) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 527 | { |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 528 | if ((Adapter->LEDInfo.LEDState[uiIndex].LED_Type == DISABLE_GPIO_NUM) || |
| 529 | (Adapter->LEDInfo.LEDState[uiIndex].LED_Type == 0x7f) || |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 530 | (Adapter->LEDInfo.LEDState[uiIndex].LED_Type == 0)) |
| 531 | uiNum_of_LED_Type++; |
| 532 | } |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 533 | if (uiNum_of_LED_Type >= NUM_OF_LEDS) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 534 | *bEnableThread = FALSE; |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 535 | |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 536 | return Status; |
| 537 | } |
| 538 | //-------------------------------------------------------------------------- |
| 539 | // Procedure: LedGpioInit |
| 540 | // |
| 541 | // Description: Initializes LED GPIOs. Makes the LED GPIOs to OUTPUT mode and make the |
| 542 | // initial state to be OFF. |
| 543 | // |
| 544 | // Arguments: |
| 545 | // Adapter - Pointer to MINI_ADAPTER structure. |
| 546 | // |
| 547 | // Returns: VOID |
| 548 | // |
| 549 | //----------------------------------------------------------------------------- |
| 550 | |
Arnd Bergmann | 44a17eff | 2010-09-30 10:24:12 +0200 | [diff] [blame] | 551 | static VOID LedGpioInit(PMINI_ADAPTER Adapter) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 552 | { |
| 553 | UINT uiResetValue = 0; |
| 554 | UINT uiIndex = 0; |
| 555 | |
| 556 | /* Set all LED GPIO Mode to output mode */ |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 557 | if (rdmalt(Adapter, GPIO_MODE_REGISTER, &uiResetValue, sizeof(uiResetValue)) < 0) |
| 558 | BCM_DEBUG_PRINT (Adapter, DBG_TYPE_OTHERS, LED_DUMP_INFO, DBG_LVL_ALL, "LED Thread: RDM Failed\n"); |
| 559 | for (uiIndex = 0; uiIndex < NUM_OF_LEDS; uiIndex++) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 560 | { |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 561 | if (Adapter->LEDInfo.LEDState[uiIndex].GPIO_Num != DISABLE_GPIO_NUM) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 562 | uiResetValue |= (1 << Adapter->LEDInfo.LEDState[uiIndex].GPIO_Num); |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 563 | TURN_OFF_LED(1 << Adapter->LEDInfo.LEDState[uiIndex].GPIO_Num, uiIndex); |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 564 | } |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 565 | if (wrmalt(Adapter, GPIO_MODE_REGISTER, &uiResetValue, sizeof(uiResetValue)) < 0) |
| 566 | BCM_DEBUG_PRINT (Adapter, DBG_TYPE_OTHERS, LED_DUMP_INFO, DBG_LVL_ALL, "LED Thread: WRM Failed\n"); |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 567 | |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 568 | Adapter->LEDInfo.bIdle_led_off = FALSE; |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 569 | } |
| 570 | //----------------------------------------------------------------------------- |
| 571 | |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 572 | static INT BcmGetGPIOPinInfo(PMINI_ADAPTER Adapter, UCHAR *GPIO_num_tx, UCHAR *GPIO_num_rx, UCHAR *uiLedTxIndex, UCHAR *uiLedRxIndex, LedEventInfo_t currdriverstate) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 573 | { |
| 574 | UINT uiIndex = 0; |
| 575 | |
| 576 | *GPIO_num_tx = DISABLE_GPIO_NUM; |
| 577 | *GPIO_num_rx = DISABLE_GPIO_NUM; |
| 578 | |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 579 | for (uiIndex = 0; uiIndex < NUM_OF_LEDS; uiIndex++) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 580 | { |
| 581 | |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 582 | if ((currdriverstate == NORMAL_OPERATION) || |
Johannes Tenschert | 34e98e7 | 2011-12-07 18:25:07 +0100 | [diff] [blame^] | 583 | (currdriverstate == IDLEMODE_EXIT) || |
| 584 | (currdriverstate == FW_DOWNLOAD)) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 585 | { |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 586 | if (Adapter->LEDInfo.LEDState[uiIndex].LED_Blink_State & currdriverstate) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 587 | { |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 588 | if (Adapter->LEDInfo.LEDState[uiIndex].GPIO_Num != DISABLE_GPIO_NUM) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 589 | { |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 590 | if (*GPIO_num_tx == DISABLE_GPIO_NUM) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 591 | { |
| 592 | *GPIO_num_tx = Adapter->LEDInfo.LEDState[uiIndex].GPIO_Num; |
| 593 | *uiLedTxIndex = uiIndex; |
| 594 | } |
| 595 | else |
| 596 | { |
| 597 | *GPIO_num_rx = Adapter->LEDInfo.LEDState[uiIndex].GPIO_Num; |
| 598 | *uiLedRxIndex = uiIndex; |
| 599 | } |
| 600 | } |
| 601 | } |
| 602 | } |
| 603 | else |
| 604 | { |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 605 | if (Adapter->LEDInfo.LEDState[uiIndex].LED_On_State & currdriverstate) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 606 | { |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 607 | if (Adapter->LEDInfo.LEDState[uiIndex].GPIO_Num != DISABLE_GPIO_NUM) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 608 | { |
| 609 | *GPIO_num_tx = Adapter->LEDInfo.LEDState[uiIndex].GPIO_Num; |
| 610 | *uiLedTxIndex = uiIndex; |
| 611 | } |
| 612 | } |
| 613 | } |
| 614 | } |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 615 | return STATUS_SUCCESS; |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 616 | } |
Arnd Bergmann | 44a17eff | 2010-09-30 10:24:12 +0200 | [diff] [blame] | 617 | static VOID LEDControlThread(PMINI_ADAPTER Adapter) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 618 | { |
| 619 | UINT uiIndex = 0; |
| 620 | UCHAR GPIO_num = 0; |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 621 | UCHAR uiLedIndex = 0; |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 622 | UINT uiResetValue = 0; |
| 623 | LedEventInfo_t currdriverstate = 0; |
| 624 | ulong timeout = 0; |
| 625 | |
| 626 | INT Status = 0; |
| 627 | |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 628 | UCHAR dummyGPIONum = 0; |
| 629 | UCHAR dummyIndex = 0; |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 630 | |
| 631 | //currdriverstate = Adapter->DriverState; |
| 632 | Adapter->LEDInfo.bIdleMode_tx_from_host = FALSE; |
| 633 | |
| 634 | /*Wait till event is triggered*/ |
| 635 | //wait_event(Adapter->LEDInfo.notify_led_event, |
| 636 | // currdriverstate!= Adapter->DriverState); |
| 637 | |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 638 | GPIO_num = DISABLE_GPIO_NUM; |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 639 | |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 640 | while (TRUE) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 641 | { |
| 642 | /*Wait till event is triggered*/ |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 643 | if ((GPIO_num == DISABLE_GPIO_NUM) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 644 | || |
Johannes Tenschert | 34e98e7 | 2011-12-07 18:25:07 +0100 | [diff] [blame^] | 645 | ((currdriverstate != FW_DOWNLOAD) && |
| 646 | (currdriverstate != NORMAL_OPERATION) && |
| 647 | (currdriverstate != LOWPOWER_MODE_ENTER)) |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 648 | || |
Johannes Tenschert | 34e98e7 | 2011-12-07 18:25:07 +0100 | [diff] [blame^] | 649 | (currdriverstate == LED_THREAD_INACTIVE)) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 650 | { |
| 651 | Status = wait_event_interruptible(Adapter->LEDInfo.notify_led_event, |
| 652 | currdriverstate != Adapter->DriverState || kthread_should_stop()); |
| 653 | } |
| 654 | |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 655 | if (kthread_should_stop() || Adapter->device_removed) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 656 | { |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 657 | BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, LED_DUMP_INFO, DBG_LVL_ALL, "Led thread got signal to exit..hence exiting"); |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 658 | Adapter->LEDInfo.led_thread_running = BCM_LED_THREAD_DISABLED; |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 659 | TURN_OFF_LED(1 << GPIO_num, uiLedIndex); |
| 660 | return;//STATUS_FAILURE; |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 661 | } |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 662 | |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 663 | if (GPIO_num != DISABLE_GPIO_NUM) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 664 | { |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 665 | TURN_OFF_LED(1 << GPIO_num, uiLedIndex); |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 666 | } |
| 667 | |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 668 | if (Adapter->LEDInfo.bLedInitDone == FALSE) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 669 | { |
| 670 | LedGpioInit(Adapter); |
| 671 | Adapter->LEDInfo.bLedInitDone = TRUE; |
| 672 | } |
| 673 | |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 674 | switch (Adapter->DriverState) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 675 | { |
Johannes Tenschert | 34e98e7 | 2011-12-07 18:25:07 +0100 | [diff] [blame^] | 676 | case DRIVER_INIT: |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 677 | { |
Johannes Tenschert | 34e98e7 | 2011-12-07 18:25:07 +0100 | [diff] [blame^] | 678 | currdriverstate = DRIVER_INIT;//Adapter->DriverState; |
| 679 | BcmGetGPIOPinInfo(Adapter, &GPIO_num, &dummyGPIONum, &uiLedIndex, &dummyIndex, currdriverstate); |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 680 | |
Johannes Tenschert | 34e98e7 | 2011-12-07 18:25:07 +0100 | [diff] [blame^] | 681 | if (GPIO_num != DISABLE_GPIO_NUM) |
| 682 | { |
| 683 | TURN_ON_LED(1 << GPIO_num, uiLedIndex); |
| 684 | } |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 685 | } |
| 686 | break; |
Johannes Tenschert | 34e98e7 | 2011-12-07 18:25:07 +0100 | [diff] [blame^] | 687 | case FW_DOWNLOAD: |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 688 | { |
Johannes Tenschert | 34e98e7 | 2011-12-07 18:25:07 +0100 | [diff] [blame^] | 689 | //BCM_DEBUG_PRINT (Adapter, DBG_TYPE_OTHERS, LED_DUMP_INFO, DBG_LVL_ALL,"LED Thread: FW_DN_DONE called\n"); |
| 690 | currdriverstate = FW_DOWNLOAD; |
| 691 | BcmGetGPIOPinInfo(Adapter, &GPIO_num, &dummyGPIONum, &uiLedIndex, &dummyIndex, currdriverstate); |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 692 | |
Johannes Tenschert | 34e98e7 | 2011-12-07 18:25:07 +0100 | [diff] [blame^] | 693 | if (GPIO_num != DISABLE_GPIO_NUM) |
| 694 | { |
| 695 | timeout = 50; |
| 696 | LED_Blink(Adapter, 1 << GPIO_num, uiLedIndex, timeout, -1, currdriverstate); |
| 697 | } |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 698 | } |
| 699 | break; |
Johannes Tenschert | 34e98e7 | 2011-12-07 18:25:07 +0100 | [diff] [blame^] | 700 | case FW_DOWNLOAD_DONE: |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 701 | { |
Johannes Tenschert | 34e98e7 | 2011-12-07 18:25:07 +0100 | [diff] [blame^] | 702 | currdriverstate = FW_DOWNLOAD_DONE; |
| 703 | BcmGetGPIOPinInfo(Adapter, &GPIO_num, &dummyGPIONum, &uiLedIndex, &dummyIndex, currdriverstate); |
| 704 | if (GPIO_num != DISABLE_GPIO_NUM) |
| 705 | { |
| 706 | TURN_ON_LED(1 << GPIO_num, uiLedIndex); |
| 707 | } |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 708 | } |
| 709 | break; |
| 710 | |
Johannes Tenschert | 34e98e7 | 2011-12-07 18:25:07 +0100 | [diff] [blame^] | 711 | case SHUTDOWN_EXIT: |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 712 | //no break, continue to NO_NETWORK_ENTRY state as well. |
| 713 | |
Johannes Tenschert | 34e98e7 | 2011-12-07 18:25:07 +0100 | [diff] [blame^] | 714 | case NO_NETWORK_ENTRY: |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 715 | { |
Johannes Tenschert | 34e98e7 | 2011-12-07 18:25:07 +0100 | [diff] [blame^] | 716 | currdriverstate = NO_NETWORK_ENTRY; |
| 717 | BcmGetGPIOPinInfo(Adapter, &GPIO_num, &dummyGPIONum, &uiLedIndex, &dummyGPIONum, currdriverstate); |
| 718 | if (GPIO_num != DISABLE_GPIO_NUM) |
| 719 | { |
| 720 | TURN_ON_LED(1 << GPIO_num, uiLedIndex); |
| 721 | } |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 722 | } |
| 723 | break; |
Johannes Tenschert | 34e98e7 | 2011-12-07 18:25:07 +0100 | [diff] [blame^] | 724 | case NORMAL_OPERATION: |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 725 | { |
Johannes Tenschert | 34e98e7 | 2011-12-07 18:25:07 +0100 | [diff] [blame^] | 726 | UCHAR GPIO_num_tx = DISABLE_GPIO_NUM; |
| 727 | UCHAR GPIO_num_rx = DISABLE_GPIO_NUM; |
| 728 | UCHAR uiLEDTx = 0; |
| 729 | UCHAR uiLEDRx = 0; |
| 730 | currdriverstate = NORMAL_OPERATION; |
| 731 | Adapter->LEDInfo.bIdle_led_off = FALSE; |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 732 | |
Johannes Tenschert | 34e98e7 | 2011-12-07 18:25:07 +0100 | [diff] [blame^] | 733 | BcmGetGPIOPinInfo(Adapter, &GPIO_num_tx, &GPIO_num_rx, &uiLEDTx, &uiLEDRx, currdriverstate); |
| 734 | if ((GPIO_num_tx == DISABLE_GPIO_NUM) && (GPIO_num_rx == DISABLE_GPIO_NUM)) |
| 735 | { |
| 736 | GPIO_num = DISABLE_GPIO_NUM; |
| 737 | } |
| 738 | else |
| 739 | { |
| 740 | /*If single LED is selected, use same for both Tx and Rx*/ |
| 741 | if (GPIO_num_tx == DISABLE_GPIO_NUM) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 742 | { |
Johannes Tenschert | 34e98e7 | 2011-12-07 18:25:07 +0100 | [diff] [blame^] | 743 | GPIO_num_tx = GPIO_num_rx; |
| 744 | uiLEDTx = uiLEDRx; |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 745 | } |
Johannes Tenschert | 34e98e7 | 2011-12-07 18:25:07 +0100 | [diff] [blame^] | 746 | else if (GPIO_num_rx == DISABLE_GPIO_NUM) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 747 | { |
Johannes Tenschert | 34e98e7 | 2011-12-07 18:25:07 +0100 | [diff] [blame^] | 748 | GPIO_num_rx = GPIO_num_tx; |
| 749 | uiLEDRx = uiLEDTx; |
| 750 | } |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 751 | /*Blink the LED in proportionate to Tx and Rx transmissions.*/ |
Johannes Tenschert | 34e98e7 | 2011-12-07 18:25:07 +0100 | [diff] [blame^] | 752 | LED_Proportional_Blink(Adapter, GPIO_num_tx, uiLEDTx, GPIO_num_rx, uiLEDRx, currdriverstate); |
| 753 | } |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 754 | } |
| 755 | break; |
Johannes Tenschert | 34e98e7 | 2011-12-07 18:25:07 +0100 | [diff] [blame^] | 756 | case LOWPOWER_MODE_ENTER: |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 757 | { |
Johannes Tenschert | 34e98e7 | 2011-12-07 18:25:07 +0100 | [diff] [blame^] | 758 | currdriverstate = LOWPOWER_MODE_ENTER; |
| 759 | if (DEVICE_POWERSAVE_MODE_AS_MANUAL_CLOCK_GATING == Adapter->ulPowerSaveMode) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 760 | { |
Johannes Tenschert | 34e98e7 | 2011-12-07 18:25:07 +0100 | [diff] [blame^] | 761 | /* Turn OFF all the LED */ |
| 762 | uiResetValue = 0; |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 763 | for (uiIndex = 0; uiIndex < NUM_OF_LEDS; uiIndex++) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 764 | { |
Johannes Tenschert | 34e98e7 | 2011-12-07 18:25:07 +0100 | [diff] [blame^] | 765 | if (Adapter->LEDInfo.LEDState[uiIndex].GPIO_Num != DISABLE_GPIO_NUM) |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 766 | TURN_OFF_LED((1 << Adapter->LEDInfo.LEDState[uiIndex].GPIO_Num), uiIndex); |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 767 | } |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 768 | |
Johannes Tenschert | 34e98e7 | 2011-12-07 18:25:07 +0100 | [diff] [blame^] | 769 | } |
| 770 | /* Turn off LED And WAKE-UP for Sendinf IDLE mode ACK */ |
| 771 | Adapter->LEDInfo.bLedInitDone = FALSE; |
| 772 | Adapter->LEDInfo.bIdle_led_off = TRUE; |
| 773 | wake_up(&Adapter->LEDInfo.idleModeSyncEvent); |
| 774 | GPIO_num = DISABLE_GPIO_NUM; |
| 775 | break; |
| 776 | } |
| 777 | case IDLEMODE_CONTINUE: |
| 778 | { |
| 779 | currdriverstate = IDLEMODE_CONTINUE; |
| 780 | GPIO_num = DISABLE_GPIO_NUM; |
| 781 | } |
| 782 | break; |
| 783 | case IDLEMODE_EXIT: |
| 784 | { |
| 785 | } |
| 786 | break; |
| 787 | case DRIVER_HALT: |
| 788 | { |
| 789 | currdriverstate = DRIVER_HALT; |
| 790 | GPIO_num = DISABLE_GPIO_NUM; |
| 791 | for (uiIndex = 0; uiIndex < NUM_OF_LEDS; uiIndex++) |
| 792 | { |
| 793 | if (Adapter->LEDInfo.LEDState[uiIndex].GPIO_Num != |
| 794 | DISABLE_GPIO_NUM) |
| 795 | TURN_OFF_LED((1 << Adapter->LEDInfo.LEDState[uiIndex].GPIO_Num), uiIndex); |
| 796 | } |
| 797 | //Adapter->DriverState = DRIVER_INIT; |
| 798 | } |
| 799 | break; |
| 800 | case LED_THREAD_INACTIVE: |
| 801 | { |
| 802 | BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, LED_DUMP_INFO, DBG_LVL_ALL, "InActivating LED thread..."); |
| 803 | currdriverstate = LED_THREAD_INACTIVE; |
| 804 | Adapter->LEDInfo.led_thread_running = BCM_LED_THREAD_RUNNING_INACTIVELY; |
| 805 | Adapter->LEDInfo.bLedInitDone = FALSE; |
| 806 | //disable ALL LED |
| 807 | for (uiIndex = 0; uiIndex < NUM_OF_LEDS; uiIndex++) |
| 808 | { |
| 809 | if (Adapter->LEDInfo.LEDState[uiIndex].GPIO_Num != |
| 810 | DISABLE_GPIO_NUM) |
| 811 | TURN_OFF_LED((1 << Adapter->LEDInfo.LEDState[uiIndex].GPIO_Num), uiIndex); |
| 812 | } |
| 813 | } |
| 814 | break; |
| 815 | case LED_THREAD_ACTIVE: |
| 816 | { |
| 817 | BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, LED_DUMP_INFO, DBG_LVL_ALL, "Activating LED thread again..."); |
| 818 | if (Adapter->LinkUpStatus == FALSE) |
| 819 | Adapter->DriverState = NO_NETWORK_ENTRY; |
| 820 | else |
| 821 | Adapter->DriverState = NORMAL_OPERATION; |
| 822 | |
| 823 | Adapter->LEDInfo.led_thread_running = BCM_LED_THREAD_RUNNING_ACTIVELY; |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 824 | } |
| 825 | break; |
| 826 | //return; |
Johannes Tenschert | 34e98e7 | 2011-12-07 18:25:07 +0100 | [diff] [blame^] | 827 | default: |
| 828 | break; |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 829 | } |
| 830 | } |
| 831 | Adapter->LEDInfo.led_thread_running = BCM_LED_THREAD_DISABLED; |
| 832 | } |
| 833 | |
| 834 | int InitLedSettings(PMINI_ADAPTER Adapter) |
| 835 | { |
| 836 | int Status = STATUS_SUCCESS; |
| 837 | BOOLEAN bEnableThread = TRUE; |
| 838 | UCHAR uiIndex = 0; |
| 839 | |
| 840 | /*Initially set BitPolarity to normal polarity. The bit 8 of LED type |
| 841 | * is used to change the polarity of the LED.*/ |
| 842 | |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 843 | for (uiIndex = 0; uiIndex < NUM_OF_LEDS; uiIndex++) { |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 844 | Adapter->LEDInfo.LEDState[uiIndex].BitPolarity = 1; |
| 845 | } |
| 846 | |
| 847 | /*Read the LED settings of CONFIG file and map it to GPIO numbers in EEPROM*/ |
| 848 | Status = ReadConfigFileStructure(Adapter, &bEnableThread); |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 849 | if (STATUS_SUCCESS != Status) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 850 | { |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 851 | BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, LED_DUMP_INFO, DBG_LVL_ALL, "LED Thread: FAILED in ReadConfigFileStructure\n"); |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 852 | return Status; |
| 853 | } |
| 854 | |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 855 | if (Adapter->LEDInfo.led_thread_running) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 856 | { |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 857 | if (bEnableThread) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 858 | ; |
| 859 | else |
| 860 | { |
| 861 | Adapter->DriverState = DRIVER_HALT; |
| 862 | wake_up(&Adapter->LEDInfo.notify_led_event); |
| 863 | Adapter->LEDInfo.led_thread_running = BCM_LED_THREAD_DISABLED; |
| 864 | } |
| 865 | |
| 866 | } |
| 867 | |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 868 | else if (bEnableThread) |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 869 | { |
| 870 | /*Create secondary thread to handle the LEDs*/ |
| 871 | init_waitqueue_head(&Adapter->LEDInfo.notify_led_event); |
| 872 | init_waitqueue_head(&Adapter->LEDInfo.idleModeSyncEvent); |
| 873 | Adapter->LEDInfo.led_thread_running = BCM_LED_THREAD_RUNNING_ACTIVELY; |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 874 | Adapter->LEDInfo.bIdle_led_off = FALSE; |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 875 | Adapter->LEDInfo.led_cntrl_threadid = kthread_run((int (*)(void *)) |
Johannes Tenschert | c1eb22d | 2011-12-07 18:25:06 +0100 | [diff] [blame] | 876 | LEDControlThread, Adapter, "led_control_thread"); |
| 877 | if (IS_ERR(Adapter->LEDInfo.led_cntrl_threadid)) |
Johannes Tenschert | 34e98e7 | 2011-12-07 18:25:07 +0100 | [diff] [blame^] | 878 | { |
| 879 | BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, LED_DUMP_INFO, DBG_LVL_ALL, "Not able to spawn Kernel Thread\n"); |
| 880 | Adapter->LEDInfo.led_thread_running = BCM_LED_THREAD_DISABLED; |
| 881 | return PTR_ERR(Adapter->LEDInfo.led_cntrl_threadid); |
| 882 | } |
Stephen Hemminger | f8942e0 | 2010-09-08 14:46:36 -0700 | [diff] [blame] | 883 | } |
| 884 | return Status; |
| 885 | } |