drivers/staging/rtl8723bs/hal/odm.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /******************************************************************************
   3  *
   4  * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.
   5  *
   6  ******************************************************************************/
   7
   8 #include "odm_precomp.h"
   9
  10 /*  Global var */
  11
  12 u32 OFDMSwingTable[OFDM_TABLE_SIZE] = {
  13         0x7f8001fe, /*  0, +6.0dB */
  14         0x788001e2, /*  1, +5.5dB */
  15         0x71c001c7, /*  2, +5.0dB */
  16         0x6b8001ae, /*  3, +4.5dB */
  17         0x65400195, /*  4, +4.0dB */
  18         0x5fc0017f, /*  5, +3.5dB */
  19         0x5a400169, /*  6, +3.0dB */
  20         0x55400155, /*  7, +2.5dB */
  21         0x50800142, /*  8, +2.0dB */
  22         0x4c000130, /*  9, +1.5dB */
  23         0x47c0011f, /*  10, +1.0dB */
  24         0x43c0010f, /*  11, +0.5dB */
  25         0x40000100, /*  12, +0dB */
  26         0x3c8000f2, /*  13, -0.5dB */
  27         0x390000e4, /*  14, -1.0dB */
  28         0x35c000d7, /*  15, -1.5dB */
  29         0x32c000cb, /*  16, -2.0dB */
  30         0x300000c0, /*  17, -2.5dB */
  31         0x2d4000b5, /*  18, -3.0dB */
  32         0x2ac000ab, /*  19, -3.5dB */
  33         0x288000a2, /*  20, -4.0dB */
  34         0x26000098, /*  21, -4.5dB */
  35         0x24000090, /*  22, -5.0dB */
  36         0x22000088, /*  23, -5.5dB */
  37         0x20000080, /*  24, -6.0dB */
  38         0x1e400079, /*  25, -6.5dB */
  39         0x1c800072, /*  26, -7.0dB */
  40         0x1b00006c, /*  27. -7.5dB */
  41         0x19800066, /*  28, -8.0dB */
  42         0x18000060, /*  29, -8.5dB */
  43         0x16c0005b, /*  30, -9.0dB */
  44         0x15800056, /*  31, -9.5dB */
  45         0x14400051, /*  32, -10.0dB */
  46         0x1300004c, /*  33, -10.5dB */
  47         0x12000048, /*  34, -11.0dB */
  48         0x11000044, /*  35, -11.5dB */
  49         0x10000040, /*  36, -12.0dB */
  50 };
  51
  52 u8 CCKSwingTable_Ch1_Ch13[CCK_TABLE_SIZE][8] = {
  53         {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04}, /*  0, +0dB */
  54         {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, /*  1, -0.5dB */
  55         {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, /*  2, -1.0dB */
  56         {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, /*  3, -1.5dB */
  57         {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, /*  4, -2.0dB */
  58         {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, /*  5, -2.5dB */
  59         {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, /*  6, -3.0dB */
  60         {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, /*  7, -3.5dB */
  61         {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, /*  8, -4.0dB */
  62         {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, /*  9, -4.5dB */
  63         {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, /*  10, -5.0dB */
  64         {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, /*  11, -5.5dB */
  65         {0x1b, 0x1a, 0x17, 0x13, 0x0e, 0x09, 0x04, 0x02}, /*  12, -6.0dB <== default */
  66         {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, /*  13, -6.5dB */
  67         {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, /*  14, -7.0dB */
  68         {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, /*  15, -7.5dB */
  69         {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, /*  16, -8.0dB */
  70         {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, /*  17, -8.5dB */
  71         {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, /*  18, -9.0dB */
  72         {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, /*  19, -9.5dB */
  73         {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, /*  20, -10.0dB */
  74         {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, /*  21, -10.5dB */
  75         {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, /*  22, -11.0dB */
  76         {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, /*  23, -11.5dB */
  77         {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, /*  24, -12.0dB */
  78         {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, /*  25, -12.5dB */
  79         {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, /*  26, -13.0dB */
  80         {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, /*  27, -13.5dB */
  81         {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, /*  28, -14.0dB */
  82         {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, /*  29, -14.5dB */
  83         {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, /*  30, -15.0dB */
  84         {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, /*  31, -15.5dB */
  85         {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01}        /*  32, -16.0dB */
  86 };
  87
  88 u8 CCKSwingTable_Ch14[CCK_TABLE_SIZE][8] = {
  89         {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00}, /*  0, +0dB */
  90         {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, /*  1, -0.5dB */
  91         {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, /*  2, -1.0dB */
  92         {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, /*  3, -1.5dB */
  93         {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, /*  4, -2.0dB */
  94         {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, /*  5, -2.5dB */
  95         {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, /*  6, -3.0dB */
  96         {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, /*  7, -3.5dB */
  97         {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, /*  8, -4.0dB */
  98         {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, /*  9, -4.5dB */
  99         {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, /*  10, -5.0dB */
 100         {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, /*  11, -5.5dB */
 101         {0x1b, 0x1a, 0x17, 0x0e, 0x00, 0x00, 0x00, 0x00}, /*  12, -6.0dB  <== default */
 102         {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, /*  13, -6.5dB */
 103         {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, /*  14, -7.0dB */
 104         {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, /*  15, -7.5dB */
 105         {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, /*  16, -8.0dB */
 106         {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, /*  17, -8.5dB */
 107         {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, /*  18, -9.0dB */
 108         {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, /*  19, -9.5dB */
 109         {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, /*  20, -10.0dB */
 110         {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, /*  21, -10.5dB */
 111         {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, /*  22, -11.0dB */
 112         {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, /*  23, -11.5dB */
 113         {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, /*  24, -12.0dB */
 114         {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, /*  25, -12.5dB */
 115         {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, /*  26, -13.0dB */
 116         {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, /*  27, -13.5dB */
 117         {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, /*  28, -14.0dB */
 118         {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, /*  29, -14.5dB */
 119         {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, /*  30, -15.0dB */
 120         {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, /*  31, -15.5dB */
 121         {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00}        /*  32, -16.0dB */
 122 };
 123
 124 u32 OFDMSwingTable_New[OFDM_TABLE_SIZE] = {
 125         0x0b40002d, /*  0,  -15.0dB */
 126         0x0c000030, /*  1,  -14.5dB */
 127         0x0cc00033, /*  2,  -14.0dB */
 128         0x0d800036, /*  3,  -13.5dB */
 129         0x0e400039, /*  4,  -13.0dB */
 130         0x0f00003c, /*  5,  -12.5dB */
 131         0x10000040, /*  6,  -12.0dB */
 132         0x11000044, /*  7,  -11.5dB */
 133         0x12000048, /*  8,  -11.0dB */
 134         0x1300004c, /*  9,  -10.5dB */
 135         0x14400051, /*  10, -10.0dB */
 136         0x15800056, /*  11, -9.5dB */
 137         0x16c0005b, /*  12, -9.0dB */
 138         0x18000060, /*  13, -8.5dB */
 139         0x19800066, /*  14, -8.0dB */
 140         0x1b00006c, /*  15, -7.5dB */
 141         0x1c800072, /*  16, -7.0dB */
 142         0x1e400079, /*  17, -6.5dB */
 143         0x20000080, /*  18, -6.0dB */
 144         0x22000088, /*  19, -5.5dB */
 145         0x24000090, /*  20, -5.0dB */
 146         0x26000098, /*  21, -4.5dB */
 147         0x288000a2, /*  22, -4.0dB */
 148         0x2ac000ab, /*  23, -3.5dB */
 149         0x2d4000b5, /*  24, -3.0dB */
 150         0x300000c0, /*  25, -2.5dB */
 151         0x32c000cb, /*  26, -2.0dB */
 152         0x35c000d7, /*  27, -1.5dB */
 153         0x390000e4, /*  28, -1.0dB */
 154         0x3c8000f2, /*  29, -0.5dB */
 155         0x40000100, /*  30, +0dB */
 156         0x43c0010f, /*  31, +0.5dB */
 157         0x47c0011f, /*  32, +1.0dB */
 158         0x4c000130, /*  33, +1.5dB */
 159         0x50800142, /*  34, +2.0dB */
 160         0x55400155, /*  35, +2.5dB */
 161         0x5a400169, /*  36, +3.0dB */
 162         0x5fc0017f, /*  37, +3.5dB */
 163         0x65400195, /*  38, +4.0dB */
 164         0x6b8001ae, /*  39, +4.5dB */
 165         0x71c001c7, /*  40, +5.0dB */
 166         0x788001e2, /*  41, +5.5dB */
 167         0x7f8001fe  /*  42, +6.0dB */
 168 };
 169
 170 u8 CCKSwingTable_Ch1_Ch13_New[CCK_TABLE_SIZE][8] = {
 171         {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01}, /*   0, -16.0dB */
 172         {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, /*   1, -15.5dB */
 173         {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, /*   2, -15.0dB */
 174         {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, /*   3, -14.5dB */
 175         {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, /*   4, -14.0dB */
 176         {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, /*   5, -13.5dB */
 177         {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, /*   6, -13.0dB */
 178         {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, /*   7, -12.5dB */
 179         {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, /*   8, -12.0dB */
 180         {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, /*   9, -11.5dB */
 181         {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, /*  10, -11.0dB */
 182         {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, /*  11, -10.5dB */
 183         {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, /*  12, -10.0dB */
 184         {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, /*  13, -9.5dB */
 185         {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, /*  14, -9.0dB */
 186         {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, /*  15, -8.5dB */
 187         {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, /*  16, -8.0dB */
 188         {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, /*  17, -7.5dB */
 189         {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, /*  18, -7.0dB */
 190         {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, /*  19, -6.5dB */
 191         {0x1b, 0x1a, 0x17, 0x13, 0x0e, 0x09, 0x04, 0x02}, /*  20, -6.0dB */
 192         {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, /*  21, -5.5dB */
 193         {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, /*  22, -5.0dB */
 194         {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, /*  23, -4.5dB */
 195         {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, /*  24, -4.0dB */
 196         {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, /*  25, -3.5dB */
 197         {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, /*  26, -3.0dB */
 198         {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, /*  27, -2.5dB */
 199         {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, /*  28, -2.0dB */
 200         {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, /*  29, -1.5dB */
 201         {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, /*  30, -1.0dB */
 202         {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, /*  31, -0.5dB */
 203         {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04}        /*  32, +0dB */
 204 };
 205
 206 u8 CCKSwingTable_Ch14_New[CCK_TABLE_SIZE][8] = {
 207         {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00}, /*   0, -16.0dB */
 208         {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, /*   1, -15.5dB */
 209         {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, /*   2, -15.0dB */
 210         {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, /*   3, -14.5dB */
 211         {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, /*   4, -14.0dB */
 212         {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, /*   5, -13.5dB */
 213         {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, /*   6, -13.0dB */
 214         {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, /*   7, -12.5dB */
 215         {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, /*   8, -12.0dB */
 216         {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, /*   9, -11.5dB */
 217         {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, /*  10, -11.0dB */
 218         {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, /*  11, -10.5dB */
 219         {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, /*  12, -10.0dB */
 220         {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, /*  13, -9.5dB */
 221         {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, /*  14, -9.0dB */
 222         {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, /*  15, -8.5dB */
 223         {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, /*  16, -8.0dB */
 224         {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, /*  17, -7.5dB */
 225         {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, /*  18, -7.0dB */
 226         {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, /*  19, -6.5dB */
 227         {0x1b, 0x1a, 0x17, 0x0e, 0x00, 0x00, 0x00, 0x00}, /*  20, -6.0dB */
 228         {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, /*  21, -5.5dB */
 229         {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, /*  22, -5.0dB */
 230         {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, /*  23, -4.5dB */
 231         {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, /*  24, -4.0dB */
 232         {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, /*  25, -3.5dB */
 233         {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, /*  26, -3.0dB */
 234         {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, /*  27, -2.5dB */
 235         {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, /*  28, -2.0dB */
 236         {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, /*  29, -1.5dB */
 237         {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, /*  30, -1.0dB */
 238         {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, /*  31, -0.5dB */
 239         {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00}        /*  32, +0dB */
 240 };
 241
 242 u32 TxScalingTable_Jaguar[TXSCALE_TABLE_SIZE] = {
 243         0x081, /*  0,  -12.0dB */
 244         0x088, /*  1,  -11.5dB */
 245         0x090, /*  2,  -11.0dB */
 246         0x099, /*  3,  -10.5dB */
 247         0x0A2, /*  4,  -10.0dB */
 248         0x0AC, /*  5,  -9.5dB */
 249         0x0B6, /*  6,  -9.0dB */
 250         0x0C0, /*  7,  -8.5dB */
 251         0x0CC, /*  8,  -8.0dB */
 252         0x0D8, /*  9,  -7.5dB */
 253         0x0E5, /*  10, -7.0dB */
 254         0x0F2, /*  11, -6.5dB */
 255         0x101, /*  12, -6.0dB */
 256         0x110, /*  13, -5.5dB */
 257         0x120, /*  14, -5.0dB */
 258         0x131, /*  15, -4.5dB */
 259         0x143, /*  16, -4.0dB */
 260         0x156, /*  17, -3.5dB */
 261         0x16A, /*  18, -3.0dB */
 262         0x180, /*  19, -2.5dB */
 263         0x197, /*  20, -2.0dB */
 264         0x1AF, /*  21, -1.5dB */
 265         0x1C8, /*  22, -1.0dB */
 266         0x1E3, /*  23, -0.5dB */
 267         0x200, /*  24, +0  dB */
 268         0x21E, /*  25, +0.5dB */
 269         0x23E, /*  26, +1.0dB */
 270         0x261, /*  27, +1.5dB */
 271         0x285, /*  28, +2.0dB */
 272         0x2AB, /*  29, +2.5dB */
 273         0x2D3, /*  30, +3.0dB */
 274         0x2FE, /*  31, +3.5dB */
 275         0x32B, /*  32, +4.0dB */
 276         0x35C, /*  33, +4.5dB */
 277         0x38E, /*  34, +5.0dB */
 278         0x3C4, /*  35, +5.5dB */
 279         0x3FE  /*  36, +6.0dB */
 280 };
 281
 282 /* Remove Edca by Yu Chen */
 283
 284 static void odm_CommonInfoSelfInit(struct dm_odm_t *pDM_Odm)
 285 {
 286         pDM_Odm->bCckHighPower = (bool) PHY_QueryBBReg(pDM_Odm->Adapter, ODM_REG(CCK_RPT_FORMAT, pDM_Odm), ODM_BIT(CCK_RPT_FORMAT, pDM_Odm));
 287         pDM_Odm->RFPathRxEnable = (u8) PHY_QueryBBReg(pDM_Odm->Adapter, ODM_REG(BB_RX_PATH, pDM_Odm), ODM_BIT(BB_RX_PATH, pDM_Odm));
 288
 289         pDM_Odm->TxRate = 0xFF;
 290 }
 291
 292 static void odm_CommonInfoSelfUpdate(struct dm_odm_t *pDM_Odm)
 293 {
 294         u8 EntryCnt = 0;
 295         u8 i;
 296         PSTA_INFO_T     pEntry;
 297
 298         if (*(pDM_Odm->pBandWidth) == ODM_BW40M) {
 299                 if (*(pDM_Odm->pSecChOffset) == 1)
 300                         pDM_Odm->ControlChannel = *(pDM_Odm->pChannel)-2;
 301                 else if (*(pDM_Odm->pSecChOffset) == 2)
 302                         pDM_Odm->ControlChannel = *(pDM_Odm->pChannel)+2;
 303         } else
 304                 pDM_Odm->ControlChannel = *(pDM_Odm->pChannel);
 305
 306         for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) {
 307                 pEntry = pDM_Odm->pODM_StaInfo[i];
 308                 if (IS_STA_VALID(pEntry))
 309                         EntryCnt++;
 310         }
 311
 312         if (EntryCnt == 1)
 313                 pDM_Odm->bOneEntryOnly = true;
 314         else
 315                 pDM_Odm->bOneEntryOnly = false;
 316 }
 317
 318 static void odm_CmnInfoInit_Debug(struct dm_odm_t *pDM_Odm)
 319 {
 320 }
 321
 322 static void odm_BasicDbgMessage(struct dm_odm_t *pDM_Odm)
 323 {
 324 }
 325
 326 /* 3 ============================================================ */
 327 /* 3 RATR MASK */
 328 /* 3 ============================================================ */
 329 /* 3 ============================================================ */
 330 /* 3 Rate Adaptive */
 331 /* 3 ============================================================ */
 332
 333 static void odm_RateAdaptiveMaskInit(struct dm_odm_t *pDM_Odm)
 334 {
 335         struct odm_rate_adaptive *pOdmRA = &pDM_Odm->RateAdaptive;
 336
 337         pOdmRA->Type = DM_Type_ByDriver;
 338         if (pOdmRA->Type == DM_Type_ByDriver)
 339                 pDM_Odm->bUseRAMask = true;
 340         else
 341                 pDM_Odm->bUseRAMask = false;
 342
 343         pOdmRA->RATRState = DM_RATR_STA_INIT;
 344         pOdmRA->LdpcThres = 35;
 345         pOdmRA->bUseLdpc = false;
 346         pOdmRA->HighRSSIThresh = 50;
 347         pOdmRA->LowRSSIThresh = 20;
 348 }
 349
 350 u32 ODM_Get_Rate_Bitmap(
 351         struct dm_odm_t *pDM_Odm,
 352         u32 macid,
 353         u32 ra_mask,
 354         u8 rssi_level
 355 )
 356 {
 357         PSTA_INFO_T     pEntry;
 358         u32 rate_bitmap = 0;
 359         u8 WirelessMode;
 360
 361         pEntry = pDM_Odm->pODM_StaInfo[macid];
 362         if (!IS_STA_VALID(pEntry))
 363                 return ra_mask;
 364
 365         WirelessMode = pEntry->wireless_mode;
 366
 367         switch (WirelessMode) {
 368         case ODM_WM_B:
 369                 if (ra_mask & 0x0000000c)               /* 11M or 5.5M enable */
 370                         rate_bitmap = 0x0000000d;
 371                 else
 372                         rate_bitmap = 0x0000000f;
 373                 break;
 374
 375         case (ODM_WM_G):
 376                 if (rssi_level == DM_RATR_STA_HIGH)
 377                         rate_bitmap = 0x00000f00;
 378                 else
 379                         rate_bitmap = 0x00000ff0;
 380                 break;
 381
 382         case (ODM_WM_B|ODM_WM_G):
 383                 if (rssi_level == DM_RATR_STA_HIGH)
 384                         rate_bitmap = 0x00000f00;
 385                 else if (rssi_level == DM_RATR_STA_MIDDLE)
 386                         rate_bitmap = 0x00000ff0;
 387                 else
 388                         rate_bitmap = 0x00000ff5;
 389                 break;
 390
 391         case (ODM_WM_B|ODM_WM_G|ODM_WM_N24G):
 392         case (ODM_WM_B|ODM_WM_N24G):
 393         case (ODM_WM_G|ODM_WM_N24G):
 394                 if (pDM_Odm->RFType == ODM_1T2R || pDM_Odm->RFType == ODM_1T1R) {
 395                         if (rssi_level == DM_RATR_STA_HIGH)
 396                                 rate_bitmap = 0x000f0000;
 397                         else if (rssi_level == DM_RATR_STA_MIDDLE)
 398                                 rate_bitmap = 0x000ff000;
 399                         else {
 400                                 if (*(pDM_Odm->pBandWidth) == ODM_BW40M)
 401                                         rate_bitmap = 0x000ff015;
 402                                 else
 403                                         rate_bitmap = 0x000ff005;
 404                         }
 405                 } else {
 406                         if (rssi_level == DM_RATR_STA_HIGH)
 407                                 rate_bitmap = 0x0f8f0000;
 408                         else if (rssi_level == DM_RATR_STA_MIDDLE)
 409                                 rate_bitmap = 0x0f8ff000;
 410                         else {
 411                                 if (*(pDM_Odm->pBandWidth) == ODM_BW40M)
 412                                         rate_bitmap = 0x0f8ff015;
 413                                 else
 414                                         rate_bitmap = 0x0f8ff005;
 415                         }
 416                 }
 417                 break;
 418
 419         default:
 420                 if (pDM_Odm->RFType == RF_1T2R)
 421                         rate_bitmap = 0x000fffff;
 422                 else
 423                         rate_bitmap = 0x0fffffff;
 424                 break;
 425         }
 426
 427         return ra_mask & rate_bitmap;
 428
 429 }
 430
 431 static void odm_RefreshRateAdaptiveMaskCE(struct dm_odm_t *pDM_Odm)
 432 {
 433         u8 i;
 434         struct adapter *padapter =  pDM_Odm->Adapter;
 435
 436         if (padapter->bDriverStopped) {
 437                 return;
 438         }
 439
 440         if (!pDM_Odm->bUseRAMask) {
 441                 return;
 442         }
 443
 444         for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) {
 445                 PSTA_INFO_T pstat = pDM_Odm->pODM_StaInfo[i];
 446
 447                 if (IS_STA_VALID(pstat)) {
 448                         if (IS_MCAST(pstat->hwaddr))  /* if (psta->mac_id == 1) */
 449                                 continue;
 450
 451                         if (true == ODM_RAStateCheck(pDM_Odm, pstat->rssi_stat.UndecoratedSmoothedPWDB, false, &pstat->rssi_level)) {
 452                                 /* printk("RSSI:%d, RSSI_LEVEL:%d\n", pstat->rssi_stat.UndecoratedSmoothedPWDB, pstat->rssi_level); */
 453                                 rtw_hal_update_ra_mask(pstat, pstat->rssi_level);
 454                         }
 455
 456                 }
 457         }
 458 }
 459
 460 /*-----------------------------------------------------------------------------
 461 * Function:     odm_RefreshRateAdaptiveMask()
 462 *
 463 * Overview:     Update rate table mask according to rssi
 464 *
 465 * Input:                NONE
 466 *
 467 * Output:               NONE
 468 *
 469 * Return:               NONE
 470 *
 471 * Revised History:
 472 *When           Who             Remark
 473 *05/27/2009     hpfan   Create Version 0.
 474 *
 475 * --------------------------------------------------------------------------
 476 */
 477 static void odm_RefreshRateAdaptiveMask(struct dm_odm_t *pDM_Odm)
 478 {
 479
 480         if (!(pDM_Odm->SupportAbility & ODM_BB_RA_MASK)) {
 481                 return;
 482         }
 483         odm_RefreshRateAdaptiveMaskCE(pDM_Odm);
 484 }
 485
 486 /*  Return Value: bool */
 487 /*  - true: RATRState is changed. */
 488 bool ODM_RAStateCheck(
 489         struct dm_odm_t *pDM_Odm,
 490         s32 RSSI,
 491         bool bForceUpdate,
 492         u8 *pRATRState
 493 )
 494 {
 495         struct odm_rate_adaptive *pRA = &pDM_Odm->RateAdaptive;
 496         const u8 GoUpGap = 5;
 497         u8 HighRSSIThreshForRA = pRA->HighRSSIThresh;
 498         u8 LowRSSIThreshForRA = pRA->LowRSSIThresh;
 499         u8 RATRState;
 500
 501         /*  Threshold Adjustment: */
 502         /*  when RSSI state trends to go up one or two levels, make sure RSSI is high enough. */
 503         /*  Here GoUpGap is added to solve the boundary's level alternation issue. */
 504         switch (*pRATRState) {
 505         case DM_RATR_STA_INIT:
 506         case DM_RATR_STA_HIGH:
 507                 break;
 508
 509         case DM_RATR_STA_MIDDLE:
 510                 HighRSSIThreshForRA += GoUpGap;
 511                 break;
 512
 513         case DM_RATR_STA_LOW:
 514                 HighRSSIThreshForRA += GoUpGap;
 515                 LowRSSIThreshForRA += GoUpGap;
 516                 break;
 517
 518         default:
 519                 netdev_dbg(pDM_Odm->Adapter->pnetdev,
 520                            "wrong rssi level setting %d !", *pRATRState);
 521                 break;
 522         }
 523
 524         /*  Decide RATRState by RSSI. */
 525         if (RSSI > HighRSSIThreshForRA)
 526                 RATRState = DM_RATR_STA_HIGH;
 527         else if (RSSI > LowRSSIThreshForRA)
 528                 RATRState = DM_RATR_STA_MIDDLE;
 529         else
 530                 RATRState = DM_RATR_STA_LOW;
 531         /* printk("==>%s, RATRState:0x%02x , RSSI:%d\n", __func__, RATRState, RSSI); */
 532
 533         if (*pRATRState != RATRState || bForceUpdate) {
 534                 *pRATRState = RATRState;
 535                 return true;
 536         }
 537
 538         return false;
 539 }
 540
 541 /*  */
 542
 543 /* 3 ============================================================ */
 544 /* 3 RSSI Monitor */
 545 /* 3 ============================================================ */
 546
 547 static void odm_RSSIMonitorInit(struct dm_odm_t *pDM_Odm)
 548 {
 549         struct ra_t *pRA_Table = &pDM_Odm->DM_RA_Table;
 550
 551         pRA_Table->firstconnect = false;
 552
 553 }
 554
 555 static void FindMinimumRSSI(struct adapter *padapter)
 556 {
 557         struct hal_com_data     *pHalData = GET_HAL_DATA(padapter);
 558         struct dm_priv *pdmpriv = &pHalData->dmpriv;
 559         struct dm_odm_t *pDM_Odm = &pHalData->odmpriv;
 560
 561         /* 1 1.Determine the minimum RSSI */
 562
 563         if (
 564                 (pDM_Odm->bLinked != true) &&
 565                 (pdmpriv->EntryMinUndecoratedSmoothedPWDB == 0)
 566         ) {
 567                 pdmpriv->MinUndecoratedPWDBForDM = 0;
 568         } else
 569                 pdmpriv->MinUndecoratedPWDBForDM = pdmpriv->EntryMinUndecoratedSmoothedPWDB;
 570 }
 571
 572 static void odm_RSSIMonitorCheckCE(struct dm_odm_t *pDM_Odm)
 573 {
 574         struct adapter *Adapter = pDM_Odm->Adapter;
 575         struct hal_com_data     *pHalData = GET_HAL_DATA(Adapter);
 576         struct dm_priv *pdmpriv = &pHalData->dmpriv;
 577         int i;
 578         int tmpEntryMaxPWDB = 0, tmpEntryMinPWDB = 0xff;
 579         u8 sta_cnt = 0;
 580         u32 PWDB_rssi[NUM_STA] = {0};/* 0~15]:MACID, [16~31]:PWDB_rssi */
 581         struct ra_t *pRA_Table = &pDM_Odm->DM_RA_Table;
 582
 583         if (pDM_Odm->bLinked != true)
 584                 return;
 585
 586         pRA_Table->firstconnect = pDM_Odm->bLinked;
 587
 588         /* if (check_fwstate(&Adapter->mlmepriv, WIFI_AP_STATE|WIFI_ADHOC_STATE|WIFI_ADHOC_MASTER_STATE) == true) */
 589         {
 590                 struct sta_info *psta;
 591
 592                 for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) {
 593                         psta = pDM_Odm->pODM_StaInfo[i];
 594                         if (IS_STA_VALID(psta)) {
 595                                 if (IS_MCAST(psta->hwaddr))  /* if (psta->mac_id == 1) */
 596                                         continue;
 597
 598                                 if (psta->rssi_stat.UndecoratedSmoothedPWDB == (-1))
 599                                         continue;
 600
 601                                 if (psta->rssi_stat.UndecoratedSmoothedPWDB < tmpEntryMinPWDB)
 602                                         tmpEntryMinPWDB = psta->rssi_stat.UndecoratedSmoothedPWDB;
 603
 604                                 if (psta->rssi_stat.UndecoratedSmoothedPWDB > tmpEntryMaxPWDB)
 605                                         tmpEntryMaxPWDB = psta->rssi_stat.UndecoratedSmoothedPWDB;
 606
 607                                 if (psta->rssi_stat.UndecoratedSmoothedPWDB != (-1))
 608                                         PWDB_rssi[sta_cnt++] = (psta->mac_id | (psta->rssi_stat.UndecoratedSmoothedPWDB<<16));
 609                         }
 610                 }
 611
 612                 /* printk("%s ==> sta_cnt(%d)\n", __func__, sta_cnt); */
 613
 614                 for (i = 0; i < sta_cnt; i++) {
 615                         if (PWDB_rssi[i] != (0)) {
 616                                 if (pHalData->fw_ractrl == true)/*  Report every sta's RSSI to FW */
 617                                         rtl8723b_set_rssi_cmd(Adapter, (u8 *)(&PWDB_rssi[i]));
 618                         }
 619                 }
 620         }
 621
 622
 623
 624         if (tmpEntryMaxPWDB != 0)       /*  If associated entry is found */
 625                 pdmpriv->EntryMaxUndecoratedSmoothedPWDB = tmpEntryMaxPWDB;
 626         else
 627                 pdmpriv->EntryMaxUndecoratedSmoothedPWDB = 0;
 628
 629         if (tmpEntryMinPWDB != 0xff) /*  If associated entry is found */
 630                 pdmpriv->EntryMinUndecoratedSmoothedPWDB = tmpEntryMinPWDB;
 631         else
 632                 pdmpriv->EntryMinUndecoratedSmoothedPWDB = 0;
 633
 634         FindMinimumRSSI(Adapter);/* get pdmpriv->MinUndecoratedPWDBForDM */
 635
 636         pDM_Odm->RSSI_Min = pdmpriv->MinUndecoratedPWDBForDM;
 637         /* ODM_CmnInfoUpdate(&pHalData->odmpriv , ODM_CMNINFO_RSSI_MIN, pdmpriv->MinUndecoratedPWDBForDM); */
 638 }
 639
 640 static void odm_RSSIMonitorCheck(struct dm_odm_t *pDM_Odm)
 641 {
 642         if (!(pDM_Odm->SupportAbility & ODM_BB_RSSI_MONITOR))
 643                 return;
 644
 645         odm_RSSIMonitorCheckCE(pDM_Odm);
 646
 647 }       /*  odm_RSSIMonitorCheck */
 648
 649 /* 3 ============================================================ */
 650 /* 3 SW Antenna Diversity */
 651 /* 3 ============================================================ */
 652 static void odm_SwAntDetectInit(struct dm_odm_t *pDM_Odm)
 653 {
 654         struct swat_t *pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table;
 655
 656         pDM_SWAT_Table->SWAS_NoLink_BK_Reg92c = rtw_read32(pDM_Odm->Adapter, rDPDT_control);
 657         pDM_SWAT_Table->PreAntenna = MAIN_ANT;
 658         pDM_SWAT_Table->CurAntenna = MAIN_ANT;
 659         pDM_SWAT_Table->SWAS_NoLink_State = 0;
 660 }
 661
 662 /* 3 ============================================================ */
 663 /* 3 Tx Power Tracking */
 664 /* 3 ============================================================ */
 665
 666 static u8 getSwingIndex(struct dm_odm_t *pDM_Odm)
 667 {
 668         struct adapter *Adapter = pDM_Odm->Adapter;
 669         u8 i = 0;
 670         u32 bbSwing;
 671         u32 swingTableSize;
 672         u32 *pSwingTable;
 673
 674         bbSwing = PHY_QueryBBReg(Adapter, rOFDM0_XATxIQImbalance, 0xFFC00000);
 675
 676         pSwingTable = OFDMSwingTable_New;
 677         swingTableSize = OFDM_TABLE_SIZE;
 678
 679         for (i = 0; i < swingTableSize; ++i) {
 680                 u32 tableValue = pSwingTable[i];
 681
 682                 if (tableValue >= 0x100000)
 683                         tableValue >>= 22;
 684                 if (bbSwing == tableValue)
 685                         break;
 686         }
 687         return i;
 688 }
 689
 690 void odm_TXPowerTrackingInit(struct dm_odm_t *pDM_Odm)
 691 {
 692         u8 defaultSwingIndex = getSwingIndex(pDM_Odm);
 693         u8 p = 0;
 694         struct adapter *Adapter = pDM_Odm->Adapter;
 695         struct hal_com_data *pHalData = GET_HAL_DATA(Adapter);
 696
 697
 698         struct dm_priv *pdmpriv = &pHalData->dmpriv;
 699
 700         pdmpriv->bTXPowerTracking = true;
 701         pdmpriv->TXPowercount = 0;
 702         pdmpriv->bTXPowerTrackingInit = false;
 703
 704         if (*(pDM_Odm->mp_mode) != 1)
 705                 pdmpriv->TxPowerTrackControl = true;
 706         else
 707                 pdmpriv->TxPowerTrackControl = false;
 708
 709         /* pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = true; */
 710         pDM_Odm->RFCalibrateInfo.ThermalValue = pHalData->EEPROMThermalMeter;
 711         pDM_Odm->RFCalibrateInfo.ThermalValue_IQK = pHalData->EEPROMThermalMeter;
 712         pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = pHalData->EEPROMThermalMeter;
 713
 714         /*  The index of "0 dB" in SwingTable. */
 715         pDM_Odm->DefaultOfdmIndex = (defaultSwingIndex >= OFDM_TABLE_SIZE) ? 30 : defaultSwingIndex;
 716         pDM_Odm->DefaultCckIndex = 20;
 717
 718         pDM_Odm->BbSwingIdxCckBase = pDM_Odm->DefaultCckIndex;
 719         pDM_Odm->RFCalibrateInfo.CCK_index = pDM_Odm->DefaultCckIndex;
 720
 721         for (p = ODM_RF_PATH_A; p < MAX_RF_PATH; ++p) {
 722                 pDM_Odm->BbSwingIdxOfdmBase[p] = pDM_Odm->DefaultOfdmIndex;
 723                 pDM_Odm->RFCalibrateInfo.OFDM_index[p] = pDM_Odm->DefaultOfdmIndex;
 724                 pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[p] = 0;
 725                 pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[p] = 0;
 726                 pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p] = 0;
 727         }
 728
 729 }
 730
 731 void ODM_TXPowerTrackingCheck(struct dm_odm_t *pDM_Odm)
 732 {
 733         struct adapter *Adapter = pDM_Odm->Adapter;
 734
 735         if (!(pDM_Odm->SupportAbility & ODM_RF_TX_PWR_TRACK))
 736                 return;
 737
 738         if (!pDM_Odm->RFCalibrateInfo.TM_Trigger) { /* at least delay 1 sec */
 739                 PHY_SetRFReg(pDM_Odm->Adapter, ODM_RF_PATH_A, RF_T_METER_NEW, (BIT17 | BIT16), 0x03);
 740
 741                 pDM_Odm->RFCalibrateInfo.TM_Trigger = 1;
 742                 return;
 743         } else {
 744                 ODM_TXPowerTrackingCallback_ThermalMeter(Adapter);
 745                 pDM_Odm->RFCalibrateInfo.TM_Trigger = 0;
 746         }
 747 }
 748
 749 /*  */
 750 /* 3 Export Interface */
 751 /*  */
 752
 753 /*  */
 754 /*  2011/09/21 MH Add to describe different team necessary resource allocate?? */
 755 /*  */
 756 void ODM_DMInit(struct dm_odm_t *pDM_Odm)
 757 {
 758
 759         odm_CommonInfoSelfInit(pDM_Odm);
 760         odm_CmnInfoInit_Debug(pDM_Odm);
 761         odm_DIGInit(pDM_Odm);
 762         odm_NHMCounterStatisticsInit(pDM_Odm);
 763         odm_AdaptivityInit(pDM_Odm);
 764         odm_RateAdaptiveMaskInit(pDM_Odm);
 765         ODM_CfoTrackingInit(pDM_Odm);
 766         ODM_EdcaTurboInit(pDM_Odm);
 767         odm_RSSIMonitorInit(pDM_Odm);
 768         odm_TXPowerTrackingInit(pDM_Odm);
 769
 770         ODM_ClearTxPowerTrackingState(pDM_Odm);
 771
 772         odm_DynamicBBPowerSavingInit(pDM_Odm);
 773         odm_DynamicTxPowerInit(pDM_Odm);
 774
 775         odm_SwAntDetectInit(pDM_Odm);
 776 }
 777
 778 /*  */
 779 /*  2011/09/20 MH This is the entry pointer for all team to execute HW out source DM. */
 780 /*  You can not add any dummy function here, be care, you can only use DM structure */
 781 /*  to perform any new ODM_DM. */
 782 /*  */
 783 void ODM_DMWatchdog(struct dm_odm_t *pDM_Odm)
 784 {
 785         odm_CommonInfoSelfUpdate(pDM_Odm);
 786         odm_BasicDbgMessage(pDM_Odm);
 787         odm_FalseAlarmCounterStatistics(pDM_Odm);
 788         odm_NHMCounterStatistics(pDM_Odm);
 789
 790         odm_RSSIMonitorCheck(pDM_Odm);
 791
 792         /* For CE Platform(SPRD or Tablet) */
 793         /* 8723A or 8189ES platform */
 794         /* NeilChen--2012--08--24-- */
 795         /* Fix Leave LPS issue */
 796         if ((adapter_to_pwrctl(pDM_Odm->Adapter)->pwr_mode != PS_MODE_ACTIVE) /*  in LPS mode */
 797                 /*  */
 798                 /* (pDM_Odm->SupportICType & (ODM_RTL8723A))|| */
 799                 /* (pDM_Odm->SupportICType & (ODM_RTL8188E) &&(&&(((pDM_Odm->SupportInterface  == ODM_ITRF_SDIO))) */
 800                 /*  */
 801         ) {
 802                         odm_DIGbyRSSI_LPS(pDM_Odm);
 803         } else
 804                 odm_DIG(pDM_Odm);
 805
 806         {
 807                 struct dig_t *pDM_DigTable = &pDM_Odm->DM_DigTable;
 808
 809                 odm_Adaptivity(pDM_Odm, pDM_DigTable->CurIGValue);
 810         }
 811         odm_CCKPacketDetectionThresh(pDM_Odm);
 812
 813         if (*(pDM_Odm->pbPowerSaving) == true)
 814                 return;
 815
 816
 817         odm_RefreshRateAdaptiveMask(pDM_Odm);
 818         odm_EdcaTurboCheck(pDM_Odm);
 819         ODM_CfoTracking(pDM_Odm);
 820
 821         ODM_TXPowerTrackingCheck(pDM_Odm);
 822
 823         /* odm_EdcaTurboCheck(pDM_Odm); */
 824
 825         /* 2010.05.30 LukeLee: For CE platform, files in IC subfolders may not be included to be compiled, */
 826         /*  so compile flags must be left here to prevent from compile errors */
 827         pDM_Odm->PhyDbgInfo.NumQryBeaconPkt = 0;
 828 }
 829
 830
 831 /*  */
 832 /*  Init /.. Fixed HW value. Only init time. */
 833 /*  */
 834 void ODM_CmnInfoInit(struct dm_odm_t *pDM_Odm, enum odm_cmninfo_e CmnInfo, u32 Value)
 835 {
 836         /*  */
 837         /*  This section is used for init value */
 838         /*  */
 839         switch (CmnInfo) {
 840         /*  */
 841         /*  Fixed ODM value. */
 842         /*  */
 843         case ODM_CMNINFO_ABILITY:
 844                 pDM_Odm->SupportAbility = (u32)Value;
 845                 break;
 846
 847         case ODM_CMNINFO_RF_TYPE:
 848                 pDM_Odm->RFType = (u8)Value;
 849                 break;
 850
 851         case ODM_CMNINFO_PLATFORM:
 852                 pDM_Odm->SupportPlatform = (u8)Value;
 853                 break;
 854
 855         case ODM_CMNINFO_INTERFACE:
 856                 pDM_Odm->SupportInterface = (u8)Value;
 857                 break;
 858
 859         case ODM_CMNINFO_MP_TEST_CHIP:
 860                 pDM_Odm->bIsMPChip = (u8)Value;
 861                 break;
 862
 863         case ODM_CMNINFO_IC_TYPE:
 864                 pDM_Odm->SupportICType = Value;
 865                 break;
 866
 867         case ODM_CMNINFO_CUT_VER:
 868                 pDM_Odm->CutVersion = (u8)Value;
 869                 break;
 870
 871         case ODM_CMNINFO_FAB_VER:
 872                 pDM_Odm->FabVersion = (u8)Value;
 873                 break;
 874
 875         case ODM_CMNINFO_RFE_TYPE:
 876                 pDM_Odm->RFEType = (u8)Value;
 877                 break;
 878
 879         case    ODM_CMNINFO_RF_ANTENNA_TYPE:
 880                 pDM_Odm->AntDivType = (u8)Value;
 881                 break;
 882
 883         case ODM_CMNINFO_PACKAGE_TYPE:
 884                 pDM_Odm->PackageType = (u8)Value;
 885                 break;
 886
 887         case ODM_CMNINFO_EXT_LNA:
 888                 pDM_Odm->ExtLNA = (u8)Value;
 889                 break;
 890
 891         case ODM_CMNINFO_EXT_PA:
 892                 pDM_Odm->ExtPA = (u8)Value;
 893                 break;
 894
 895         case ODM_CMNINFO_GPA:
 896                 pDM_Odm->TypeGPA = (enum odm_type_gpa_e)Value;
 897                 break;
 898         case ODM_CMNINFO_APA:
 899                 pDM_Odm->TypeAPA = (enum odm_type_apa_e)Value;
 900                 break;
 901         case ODM_CMNINFO_GLNA:
 902                 pDM_Odm->TypeGLNA = (enum odm_type_glna_e)Value;
 903                 break;
 904         case ODM_CMNINFO_ALNA:
 905                 pDM_Odm->TypeALNA = (enum odm_type_alna_e)Value;
 906                 break;
 907
 908         case ODM_CMNINFO_EXT_TRSW:
 909                 pDM_Odm->ExtTRSW = (u8)Value;
 910                 break;
 911         case ODM_CMNINFO_PATCH_ID:
 912                 pDM_Odm->PatchID = (u8)Value;
 913                 break;
 914         case ODM_CMNINFO_BINHCT_TEST:
 915                 pDM_Odm->bInHctTest = (bool)Value;
 916                 break;
 917         case ODM_CMNINFO_BWIFI_TEST:
 918                 pDM_Odm->bWIFITest = (bool)Value;
 919                 break;
 920
 921         case ODM_CMNINFO_SMART_CONCURRENT:
 922                 pDM_Odm->bDualMacSmartConcurrent = (bool)Value;
 923                 break;
 924
 925         /* To remove the compiler warning, must add an empty default statement to handle the other values. */
 926         default:
 927                 /* do nothing */
 928                 break;
 929         }
 930
 931 }
 932
 933
 934 void ODM_CmnInfoHook(struct dm_odm_t *pDM_Odm, enum odm_cmninfo_e CmnInfo, void *pValue)
 935 {
 936         /*  */
 937         /*  Hook call by reference pointer. */
 938         /*  */
 939         switch (CmnInfo) {
 940         /*  */
 941         /*  Dynamic call by reference pointer. */
 942         /*  */
 943         case ODM_CMNINFO_MAC_PHY_MODE:
 944                 pDM_Odm->pMacPhyMode = pValue;
 945                 break;
 946
 947         case ODM_CMNINFO_TX_UNI:
 948                 pDM_Odm->pNumTxBytesUnicast = pValue;
 949                 break;
 950
 951         case ODM_CMNINFO_RX_UNI:
 952                 pDM_Odm->pNumRxBytesUnicast = pValue;
 953                 break;
 954
 955         case ODM_CMNINFO_WM_MODE:
 956                 pDM_Odm->pwirelessmode = pValue;
 957                 break;
 958
 959         case ODM_CMNINFO_SEC_CHNL_OFFSET:
 960                 pDM_Odm->pSecChOffset = pValue;
 961                 break;
 962
 963         case ODM_CMNINFO_SEC_MODE:
 964                 pDM_Odm->pSecurity = pValue;
 965                 break;
 966
 967         case ODM_CMNINFO_BW:
 968                 pDM_Odm->pBandWidth = pValue;
 969                 break;
 970
 971         case ODM_CMNINFO_CHNL:
 972                 pDM_Odm->pChannel = pValue;
 973                 break;
 974
 975         case ODM_CMNINFO_DMSP_GET_VALUE:
 976                 pDM_Odm->pbGetValueFromOtherMac = pValue;
 977                 break;
 978
 979         case ODM_CMNINFO_BUDDY_ADAPTOR:
 980                 pDM_Odm->pBuddyAdapter = pValue;
 981                 break;
 982
 983         case ODM_CMNINFO_DMSP_IS_MASTER:
 984                 pDM_Odm->pbMasterOfDMSP = pValue;
 985                 break;
 986
 987         case ODM_CMNINFO_SCAN:
 988                 pDM_Odm->pbScanInProcess = pValue;
 989                 break;
 990
 991         case ODM_CMNINFO_POWER_SAVING:
 992                 pDM_Odm->pbPowerSaving = pValue;
 993                 break;
 994
 995         case ODM_CMNINFO_ONE_PATH_CCA:
 996                 pDM_Odm->pOnePathCCA = pValue;
 997                 break;
 998
 999         case ODM_CMNINFO_DRV_STOP:
1000                 pDM_Odm->pbDriverStopped =  pValue;
1001                 break;
1002
1003         case ODM_CMNINFO_PNP_IN:
1004                 pDM_Odm->pbDriverIsGoingToPnpSetPowerSleep =  pValue;
1005                 break;
1006
1007         case ODM_CMNINFO_INIT_ON:
1008                 pDM_Odm->pinit_adpt_in_progress =  pValue;
1009                 break;
1010
1011         case ODM_CMNINFO_ANT_TEST:
1012                 pDM_Odm->pAntennaTest =  pValue;
1013                 break;
1014
1015         case ODM_CMNINFO_NET_CLOSED:
1016                 pDM_Odm->pbNet_closed = pValue;
1017                 break;
1018
1019         case ODM_CMNINFO_FORCED_RATE:
1020                 pDM_Odm->pForcedDataRate = pValue;
1021                 break;
1022
1023         case ODM_CMNINFO_FORCED_IGI_LB:
1024                 pDM_Odm->pu1ForcedIgiLb = pValue;
1025                 break;
1026
1027         case ODM_CMNINFO_MP_MODE:
1028                 pDM_Odm->mp_mode = pValue;
1029                 break;
1030
1031         /* case ODM_CMNINFO_RTSTA_AID: */
1032         /* pDM_Odm->pAidMap =  (u8 *)pValue; */
1033         /* break; */
1034
1035         /* case ODM_CMNINFO_BT_COEXIST: */
1036         /* pDM_Odm->BTCoexist = (bool *)pValue; */
1037
1038         /* case ODM_CMNINFO_STA_STATUS: */
1039         /* pDM_Odm->pODM_StaInfo[] = (PSTA_INFO_T)pValue; */
1040         /* break; */
1041
1042         /* case ODM_CMNINFO_PHY_STATUS: */
1043         /* pDM_Odm->pPhyInfo = (ODM_PHY_INFO *)pValue; */
1044         /* break; */
1045
1046         /* case ODM_CMNINFO_MAC_STATUS: */
1047         /* pDM_Odm->pMacInfo = (struct odm_mac_status_info *)pValue; */
1048         /* break; */
1049         /* To remove the compiler warning, must add an empty default statement to handle the other values. */
1050         default:
1051                 /* do nothing */
1052                 break;
1053         }
1054
1055 }
1056
1057
1058 void ODM_CmnInfoPtrArrayHook(
1059         struct dm_odm_t *pDM_Odm,
1060         enum odm_cmninfo_e CmnInfo,
1061         u16 Index,
1062         void *pValue
1063 )
1064 {
1065         /*  */
1066         /*  Hook call by reference pointer. */
1067         /*  */
1068         switch (CmnInfo) {
1069         /*  */
1070         /*  Dynamic call by reference pointer. */
1071         /*  */
1072         case ODM_CMNINFO_STA_STATUS:
1073                 pDM_Odm->pODM_StaInfo[Index] = (PSTA_INFO_T)pValue;
1074                 break;
1075         /* To remove the compiler warning, must add an empty default statement to handle the other values. */
1076         default:
1077                 /* do nothing */
1078                 break;
1079         }
1080
1081 }
1082
1083
1084 /*  */
1085 /*  Update Band/CHannel/.. The values are dynamic but non-per-packet. */
1086 /*  */
1087 void ODM_CmnInfoUpdate(struct dm_odm_t *pDM_Odm, u32 CmnInfo, u64 Value)
1088 {
1089         /*  */
1090         /*  This init variable may be changed in run time. */
1091         /*  */
1092         switch (CmnInfo) {
1093         case ODM_CMNINFO_LINK_IN_PROGRESS:
1094                 pDM_Odm->bLinkInProcess = (bool)Value;
1095                 break;
1096
1097         case ODM_CMNINFO_ABILITY:
1098                 pDM_Odm->SupportAbility = (u32)Value;
1099                 break;
1100
1101         case ODM_CMNINFO_RF_TYPE:
1102                 pDM_Odm->RFType = (u8)Value;
1103                 break;
1104
1105         case ODM_CMNINFO_WIFI_DIRECT:
1106                 pDM_Odm->bWIFI_Direct = (bool)Value;
1107                 break;
1108
1109         case ODM_CMNINFO_WIFI_DISPLAY:
1110                 pDM_Odm->bWIFI_Display = (bool)Value;
1111                 break;
1112
1113         case ODM_CMNINFO_LINK:
1114                 pDM_Odm->bLinked = (bool)Value;
1115                 break;
1116
1117         case ODM_CMNINFO_STATION_STATE:
1118                 pDM_Odm->bsta_state = (bool)Value;
1119                 break;
1120
1121         case ODM_CMNINFO_RSSI_MIN:
1122                 pDM_Odm->RSSI_Min = (u8)Value;
1123                 break;
1124
1125         case ODM_CMNINFO_RA_THRESHOLD_HIGH:
1126                 pDM_Odm->RateAdaptive.HighRSSIThresh = (u8)Value;
1127                 break;
1128
1129         case ODM_CMNINFO_RA_THRESHOLD_LOW:
1130                 pDM_Odm->RateAdaptive.LowRSSIThresh = (u8)Value;
1131                 break;
1132         /*  The following is for BT HS mode and BT coexist mechanism. */
1133         case ODM_CMNINFO_BT_ENABLED:
1134                 pDM_Odm->bBtEnabled = (bool)Value;
1135                 break;
1136
1137         case ODM_CMNINFO_BT_HS_CONNECT_PROCESS:
1138                 pDM_Odm->bBtConnectProcess = (bool)Value;
1139                 break;
1140
1141         case ODM_CMNINFO_BT_HS_RSSI:
1142                 pDM_Odm->btHsRssi = (u8)Value;
1143                 break;
1144
1145         case ODM_CMNINFO_BT_OPERATION:
1146                 pDM_Odm->bBtHsOperation = (bool)Value;
1147                 break;
1148
1149         case ODM_CMNINFO_BT_LIMITED_DIG:
1150                 pDM_Odm->bBtLimitedDig = (bool)Value;
1151                 break;
1152
1153         case ODM_CMNINFO_BT_DISABLE_EDCA:
1154                 pDM_Odm->bBtDisableEdcaTurbo = (bool)Value;
1155                 break;
1156
1157 /*
1158         case    ODM_CMNINFO_OP_MODE:
1159                 pDM_Odm->OPMode = (u8)Value;
1160                 break;
1161
1162         case    ODM_CMNINFO_WM_MODE:
1163                 pDM_Odm->WirelessMode = (u8)Value;
1164                 break;
1165
1166         case    ODM_CMNINFO_SEC_CHNL_OFFSET:
1167                 pDM_Odm->SecChOffset = (u8)Value;
1168                 break;
1169
1170         case    ODM_CMNINFO_SEC_MODE:
1171                 pDM_Odm->Security = (u8)Value;
1172                 break;
1173
1174         case    ODM_CMNINFO_BW:
1175                 pDM_Odm->BandWidth = (u8)Value;
1176                 break;
1177
1178         case    ODM_CMNINFO_CHNL:
1179                 pDM_Odm->Channel = (u8)Value;
1180                 break;
1181 */
1182         default:
1183                 /* do nothing */
1184                 break;
1185         }
1186
1187
1188 }
1189
1190 /* 3 ============================================================ */
1191 /* 3 DIG */
1192 /* 3 ============================================================ */
1193 /*-----------------------------------------------------------------------------
1194  * Function:    odm_DIGInit()
1195  *
1196  * Overview:    Set DIG scheme init value.
1197  *
1198  * Input:               NONE
1199  *
1200  * Output:              NONE
1201  *
1202  * Return:              NONE
1203  *
1204  * Revised History:
1205  *When          Who             Remark
1206  *
1207  *---------------------------------------------------------------------------
1208  */
1209
1210 /* Remove DIG by yuchen */
1211
1212 /* Remove DIG and FA check by Yu Chen */
1213
1214 /* 3 ============================================================ */
1215 /* 3 BB Power Save */
1216 /* 3 ============================================================ */
1217
1218 /* Remove BB power saving by Yuchen */
1219
1220 /* 3 ============================================================ */
1221 /* 3 Dynamic Tx Power */
1222 /* 3 ============================================================ */
1223
1224 /* Remove BY YuChen */
1225