This source file includes following definitions.
- e1000_calculate_checksum
- e1000_mng_enable_host_if
- e1000e_check_mng_mode_generic
- e1000e_enable_tx_pkt_filtering
- e1000_mng_write_cmd_header
- e1000_mng_host_if_write
- e1000e_mng_write_dhcp_info
- e1000e_enable_mng_pass_thru
   1 
   2 
   3 
   4 #include "e1000.h"
   5 
   6 
   7 
   8 
   9 
  10 
  11 
  12 
  13 
  14 static u8 e1000_calculate_checksum(u8 *buffer, u32 length)
  15 {
  16         u32 i;
  17         u8 sum = 0;
  18 
  19         if (!buffer)
  20                 return 0;
  21 
  22         for (i = 0; i < length; i++)
  23                 sum += buffer[i];
  24 
  25         return (u8)(0 - sum);
  26 }
  27 
  28 
  29 
  30 
  31 
  32 
  33 
  34 
  35 
  36 
  37 
  38 static s32 e1000_mng_enable_host_if(struct e1000_hw *hw)
  39 {
  40         u32 hicr;
  41         u8 i;
  42 
  43         if (!hw->mac.arc_subsystem_valid) {
  44                 e_dbg("ARC subsystem not valid.\n");
  45                 return -E1000_ERR_HOST_INTERFACE_COMMAND;
  46         }
  47 
  48         
  49         hicr = er32(HICR);
  50         if (!(hicr & E1000_HICR_EN)) {
  51                 e_dbg("E1000_HOST_EN bit disabled.\n");
  52                 return -E1000_ERR_HOST_INTERFACE_COMMAND;
  53         }
  54         
  55         for (i = 0; i < E1000_MNG_DHCP_COMMAND_TIMEOUT; i++) {
  56                 hicr = er32(HICR);
  57                 if (!(hicr & E1000_HICR_C))
  58                         break;
  59                 mdelay(1);
  60         }
  61 
  62         if (i == E1000_MNG_DHCP_COMMAND_TIMEOUT) {
  63                 e_dbg("Previous command timeout failed.\n");
  64                 return -E1000_ERR_HOST_INTERFACE_COMMAND;
  65         }
  66 
  67         return 0;
  68 }
  69 
  70 
  71 
  72 
  73 
  74 
  75 
  76 
  77 bool e1000e_check_mng_mode_generic(struct e1000_hw *hw)
  78 {
  79         u32 fwsm = er32(FWSM);
  80 
  81         return (fwsm & E1000_FWSM_MODE_MASK) ==
  82             (E1000_MNG_IAMT_MODE << E1000_FWSM_MODE_SHIFT);
  83 }
  84 
  85 
  86 
  87 
  88 
  89 
  90 
  91 
  92 bool e1000e_enable_tx_pkt_filtering(struct e1000_hw *hw)
  93 {
  94         struct e1000_host_mng_dhcp_cookie *hdr = &hw->mng_cookie;
  95         u32 *buffer = (u32 *)&hw->mng_cookie;
  96         u32 offset;
  97         s32 ret_val, hdr_csum, csum;
  98         u8 i, len;
  99 
 100         hw->mac.tx_pkt_filtering = true;
 101 
 102         
 103         if (!hw->mac.ops.check_mng_mode(hw)) {
 104                 hw->mac.tx_pkt_filtering = false;
 105                 return hw->mac.tx_pkt_filtering;
 106         }
 107 
 108         
 109 
 110 
 111         ret_val = e1000_mng_enable_host_if(hw);
 112         if (ret_val) {
 113                 hw->mac.tx_pkt_filtering = false;
 114                 return hw->mac.tx_pkt_filtering;
 115         }
 116 
 117         
 118         len = E1000_MNG_DHCP_COOKIE_LENGTH >> 2;
 119         offset = E1000_MNG_DHCP_COOKIE_OFFSET >> 2;
 120         for (i = 0; i < len; i++)
 121                 *(buffer + i) = E1000_READ_REG_ARRAY(hw, E1000_HOST_IF,
 122                                                      offset + i);
 123         hdr_csum = hdr->checksum;
 124         hdr->checksum = 0;
 125         csum = e1000_calculate_checksum((u8 *)hdr,
 126                                         E1000_MNG_DHCP_COOKIE_LENGTH);
 127         
 128 
 129 
 130 
 131         if ((hdr_csum != csum) || (hdr->signature != E1000_IAMT_SIGNATURE)) {
 132                 hw->mac.tx_pkt_filtering = true;
 133                 return hw->mac.tx_pkt_filtering;
 134         }
 135 
 136         
 137         if (!(hdr->status & E1000_MNG_DHCP_COOKIE_STATUS_PARSING))
 138                 hw->mac.tx_pkt_filtering = false;
 139 
 140         return hw->mac.tx_pkt_filtering;
 141 }
 142 
 143 
 144 
 145 
 146 
 147 
 148 
 149 
 150 static s32 e1000_mng_write_cmd_header(struct e1000_hw *hw,
 151                                       struct e1000_host_mng_command_header *hdr)
 152 {
 153         u16 i, length = sizeof(struct e1000_host_mng_command_header);
 154 
 155         
 156 
 157         hdr->checksum = e1000_calculate_checksum((u8 *)hdr, length);
 158 
 159         length >>= 2;
 160         
 161         for (i = 0; i < length; i++) {
 162                 E1000_WRITE_REG_ARRAY(hw, E1000_HOST_IF, i, *((u32 *)hdr + i));
 163                 e1e_flush();
 164         }
 165 
 166         return 0;
 167 }
 168 
 169 
 170 
 171 
 172 
 173 
 174 
 175 
 176 
 177 
 178 
 179 
 180 
 181 static s32 e1000_mng_host_if_write(struct e1000_hw *hw, u8 *buffer,
 182                                    u16 length, u16 offset, u8 *sum)
 183 {
 184         u8 *tmp;
 185         u8 *bufptr = buffer;
 186         u32 data = 0;
 187         u16 remaining, i, j, prev_bytes;
 188 
 189         
 190 
 191         if (length == 0 || offset + length > E1000_HI_MAX_MNG_DATA_LENGTH)
 192                 return -E1000_ERR_PARAM;
 193 
 194         tmp = (u8 *)&data;
 195         prev_bytes = offset & 0x3;
 196         offset >>= 2;
 197 
 198         if (prev_bytes) {
 199                 data = E1000_READ_REG_ARRAY(hw, E1000_HOST_IF, offset);
 200                 for (j = prev_bytes; j < sizeof(u32); j++) {
 201                         *(tmp + j) = *bufptr++;
 202                         *sum += *(tmp + j);
 203                 }
 204                 E1000_WRITE_REG_ARRAY(hw, E1000_HOST_IF, offset, data);
 205                 length -= j - prev_bytes;
 206                 offset++;
 207         }
 208 
 209         remaining = length & 0x3;
 210         length -= remaining;
 211 
 212         
 213         length >>= 2;
 214 
 215         
 216 
 217 
 218         for (i = 0; i < length; i++) {
 219                 for (j = 0; j < sizeof(u32); j++) {
 220                         *(tmp + j) = *bufptr++;
 221                         *sum += *(tmp + j);
 222                 }
 223 
 224                 E1000_WRITE_REG_ARRAY(hw, E1000_HOST_IF, offset + i, data);
 225         }
 226         if (remaining) {
 227                 for (j = 0; j < sizeof(u32); j++) {
 228                         if (j < remaining)
 229                                 *(tmp + j) = *bufptr++;
 230                         else
 231                                 *(tmp + j) = 0;
 232 
 233                         *sum += *(tmp + j);
 234                 }
 235                 E1000_WRITE_REG_ARRAY(hw, E1000_HOST_IF, offset + i, data);
 236         }
 237 
 238         return 0;
 239 }
 240 
 241 
 242 
 243 
 244 
 245 
 246 
 247 
 248 
 249 s32 e1000e_mng_write_dhcp_info(struct e1000_hw *hw, u8 *buffer, u16 length)
 250 {
 251         struct e1000_host_mng_command_header hdr;
 252         s32 ret_val;
 253         u32 hicr;
 254 
 255         hdr.command_id = E1000_MNG_DHCP_TX_PAYLOAD_CMD;
 256         hdr.command_length = length;
 257         hdr.reserved1 = 0;
 258         hdr.reserved2 = 0;
 259         hdr.checksum = 0;
 260 
 261         
 262         ret_val = e1000_mng_enable_host_if(hw);
 263         if (ret_val)
 264                 return ret_val;
 265 
 266         
 267         ret_val = e1000_mng_host_if_write(hw, buffer, length,
 268                                           sizeof(hdr), &(hdr.checksum));
 269         if (ret_val)
 270                 return ret_val;
 271 
 272         
 273         ret_val = e1000_mng_write_cmd_header(hw, &hdr);
 274         if (ret_val)
 275                 return ret_val;
 276 
 277         
 278         hicr = er32(HICR);
 279         ew32(HICR, hicr | E1000_HICR_C);
 280 
 281         return 0;
 282 }
 283 
 284 
 285 
 286 
 287 
 288 
 289 
 290 
 291 bool e1000e_enable_mng_pass_thru(struct e1000_hw *hw)
 292 {
 293         u32 manc;
 294         u32 fwsm, factps;
 295 
 296         manc = er32(MANC);
 297 
 298         if (!(manc & E1000_MANC_RCV_TCO_EN))
 299                 return false;
 300 
 301         if (hw->mac.has_fwsm) {
 302                 fwsm = er32(FWSM);
 303                 factps = er32(FACTPS);
 304 
 305                 if (!(factps & E1000_FACTPS_MNGCG) &&
 306                     ((fwsm & E1000_FWSM_MODE_MASK) ==
 307                      (e1000_mng_mode_pt << E1000_FWSM_MODE_SHIFT)))
 308                         return true;
 309         } else if ((hw->mac.type == e1000_82574) ||
 310                    (hw->mac.type == e1000_82583)) {
 311                 u16 data;
 312                 s32 ret_val;
 313 
 314                 factps = er32(FACTPS);
 315                 ret_val = e1000_read_nvm(hw, NVM_INIT_CONTROL2_REG, 1, &data);
 316                 if (ret_val)
 317                         return false;
 318 
 319                 if (!(factps & E1000_FACTPS_MNGCG) &&
 320                     ((data & E1000_NVM_INIT_CTRL2_MNGM) ==
 321                      (e1000_mng_mode_pt << 13)))
 322                         return true;
 323         } else if ((manc & E1000_MANC_SMBUS_EN) &&
 324                    !(manc & E1000_MANC_ASF_EN)) {
 325                 return true;
 326         }
 327 
 328         return false;
 329 }