drivers/staging/rtl8723bs/hal/odm.c

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