devices/e1000/e1000_hw-2.6.31-ethercat.c
author Gavin Lambert <gavinl@compacsort.com>
Tue, 14 Apr 2015 09:33:24 -0400
changeset 2618 3affe9cd0b66
parent 1996 852668fdae6a
permissions -rw-r--r--
Ignore NXIO error otherwise this causes spam if network is empty or refclk not
selected yet, and syncing refclk time to master.
1996
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
     1
/*******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
     2
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
     3
  Intel PRO/1000 Linux driver
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
     4
  Copyright(c) 1999 - 2006 Intel Corporation.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
     5
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
     6
  This program is free software; you can redistribute it and/or modify it
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
     7
  under the terms and conditions of the GNU General Public License,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
     8
  version 2, as published by the Free Software Foundation.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
     9
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    10
  This program is distributed in the hope it will be useful, but WITHOUT
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    11
  ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    12
  FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    13
  more details.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    14
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    15
  You should have received a copy of the GNU General Public License along with
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    16
  this program; if not, write to the Free Software Foundation, Inc.,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    17
  51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    18
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    19
  The full GNU General Public License is included in this distribution in
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    20
  the file called "COPYING".
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    21
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    22
  Contact Information:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    23
  Linux NICS <linux.nics@intel.com>
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    24
  e1000-devel Mailing List <e1000-devel@lists.sourceforge.net>
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    25
  Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    26
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    27
*******************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    28
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    29
/* e1000_hw.c
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    30
 * Shared functions for accessing and configuring the MAC
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    31
 */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    32
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    33
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    34
#include "e1000_hw-2.6.31-ethercat.h"
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    35
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    36
static s32 e1000_swfw_sync_acquire(struct e1000_hw *hw, u16 mask);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    37
static void e1000_swfw_sync_release(struct e1000_hw *hw, u16 mask);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    38
static s32 e1000_read_kmrn_reg(struct e1000_hw *hw, u32 reg_addr, u16 *data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    39
static s32 e1000_write_kmrn_reg(struct e1000_hw *hw, u32 reg_addr, u16 data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    40
static s32 e1000_get_software_semaphore(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    41
static void e1000_release_software_semaphore(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    42
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    43
static u8 e1000_arc_subsystem_valid(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    44
static s32 e1000_check_downshift(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    45
static s32 e1000_check_polarity(struct e1000_hw *hw,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    46
				e1000_rev_polarity *polarity);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    47
static void e1000_clear_hw_cntrs(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    48
static void e1000_clear_vfta(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    49
static s32 e1000_commit_shadow_ram(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    50
static s32 e1000_config_dsp_after_link_change(struct e1000_hw *hw,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    51
					      bool link_up);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    52
static s32 e1000_config_fc_after_link_up(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    53
static s32 e1000_detect_gig_phy(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    54
static s32 e1000_erase_ich8_4k_segment(struct e1000_hw *hw, u32 bank);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    55
static s32 e1000_get_auto_rd_done(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    56
static s32 e1000_get_cable_length(struct e1000_hw *hw, u16 *min_length,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    57
				  u16 *max_length);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    58
static s32 e1000_get_hw_eeprom_semaphore(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    59
static s32 e1000_get_phy_cfg_done(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    60
static s32 e1000_get_software_flag(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    61
static s32 e1000_ich8_cycle_init(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    62
static s32 e1000_ich8_flash_cycle(struct e1000_hw *hw, u32 timeout);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    63
static s32 e1000_id_led_init(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    64
static s32 e1000_init_lcd_from_nvm_config_region(struct e1000_hw *hw,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    65
						 u32 cnf_base_addr,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    66
						 u32 cnf_size);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    67
static s32 e1000_init_lcd_from_nvm(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    68
static void e1000_init_rx_addrs(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    69
static void e1000_initialize_hardware_bits(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    70
static bool e1000_is_onboard_nvm_eeprom(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    71
static s32 e1000_kumeran_lock_loss_workaround(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    72
static s32 e1000_mng_enable_host_if(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    73
static s32 e1000_mng_host_if_write(struct e1000_hw *hw, u8 *buffer, u16 length,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    74
				   u16 offset, u8 *sum);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    75
static s32 e1000_mng_write_cmd_header(struct e1000_hw* hw,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    76
				      struct e1000_host_mng_command_header
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    77
				      *hdr);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    78
static s32 e1000_mng_write_commit(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    79
static s32 e1000_phy_ife_get_info(struct e1000_hw *hw,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    80
				  struct e1000_phy_info *phy_info);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    81
static s32 e1000_phy_igp_get_info(struct e1000_hw *hw,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    82
				  struct e1000_phy_info *phy_info);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    83
static s32 e1000_read_eeprom_eerd(struct e1000_hw *hw, u16 offset, u16 words,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    84
				  u16 *data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    85
static s32 e1000_write_eeprom_eewr(struct e1000_hw *hw, u16 offset, u16 words,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    86
				   u16 *data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    87
static s32 e1000_poll_eerd_eewr_done(struct e1000_hw *hw, int eerd);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    88
static s32 e1000_phy_m88_get_info(struct e1000_hw *hw,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    89
				  struct e1000_phy_info *phy_info);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    90
static void e1000_put_hw_eeprom_semaphore(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    91
static s32 e1000_read_ich8_byte(struct e1000_hw *hw, u32 index, u8 *data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    92
static s32 e1000_verify_write_ich8_byte(struct e1000_hw *hw, u32 index,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    93
					u8 byte);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    94
static s32 e1000_write_ich8_byte(struct e1000_hw *hw, u32 index, u8 byte);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    95
static s32 e1000_read_ich8_word(struct e1000_hw *hw, u32 index, u16 *data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    96
static s32 e1000_read_ich8_data(struct e1000_hw *hw, u32 index, u32 size,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    97
				u16 *data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    98
static s32 e1000_write_ich8_data(struct e1000_hw *hw, u32 index, u32 size,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
    99
				 u16 data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   100
static s32 e1000_read_eeprom_ich8(struct e1000_hw *hw, u16 offset, u16 words,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   101
				  u16 *data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   102
static s32 e1000_write_eeprom_ich8(struct e1000_hw *hw, u16 offset, u16 words,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   103
				   u16 *data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   104
static void e1000_release_software_flag(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   105
static s32 e1000_set_d3_lplu_state(struct e1000_hw *hw, bool active);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   106
static s32 e1000_set_d0_lplu_state(struct e1000_hw *hw, bool active);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   107
static s32 e1000_set_pci_ex_no_snoop(struct e1000_hw *hw, u32 no_snoop);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   108
static void e1000_set_pci_express_master_disable(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   109
static s32 e1000_wait_autoneg(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   110
static void e1000_write_reg_io(struct e1000_hw *hw, u32 offset, u32 value);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   111
static s32 e1000_set_phy_type(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   112
static void e1000_phy_init_script(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   113
static s32 e1000_setup_copper_link(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   114
static s32 e1000_setup_fiber_serdes_link(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   115
static s32 e1000_adjust_serdes_amplitude(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   116
static s32 e1000_phy_force_speed_duplex(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   117
static s32 e1000_config_mac_to_phy(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   118
static void e1000_raise_mdi_clk(struct e1000_hw *hw, u32 *ctrl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   119
static void e1000_lower_mdi_clk(struct e1000_hw *hw, u32 *ctrl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   120
static void e1000_shift_out_mdi_bits(struct e1000_hw *hw, u32 data,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   121
				     u16 count);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   122
static u16 e1000_shift_in_mdi_bits(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   123
static s32 e1000_phy_reset_dsp(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   124
static s32 e1000_write_eeprom_spi(struct e1000_hw *hw, u16 offset,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   125
                                      u16 words, u16 *data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   126
static s32 e1000_write_eeprom_microwire(struct e1000_hw *hw, u16 offset,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   127
					u16 words, u16 *data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   128
static s32 e1000_spi_eeprom_ready(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   129
static void e1000_raise_ee_clk(struct e1000_hw *hw, u32 *eecd);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   130
static void e1000_lower_ee_clk(struct e1000_hw *hw, u32 *eecd);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   131
static void e1000_shift_out_ee_bits(struct e1000_hw *hw, u16 data, u16 count);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   132
static s32 e1000_write_phy_reg_ex(struct e1000_hw *hw, u32 reg_addr,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   133
				  u16 phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   134
static s32 e1000_read_phy_reg_ex(struct e1000_hw *hw,u32 reg_addr,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   135
				 u16 *phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   136
static u16 e1000_shift_in_ee_bits(struct e1000_hw *hw, u16 count);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   137
static s32 e1000_acquire_eeprom(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   138
static void e1000_release_eeprom(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   139
static void e1000_standby_eeprom(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   140
static s32 e1000_set_vco_speed(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   141
static s32 e1000_polarity_reversal_workaround(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   142
static s32 e1000_set_phy_mode(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   143
static s32 e1000_host_if_read_cookie(struct e1000_hw *hw, u8 *buffer);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   144
static u8 e1000_calculate_mng_checksum(char *buffer, u32 length);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   145
static s32 e1000_configure_kmrn_for_10_100(struct e1000_hw *hw, u16 duplex);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   146
static s32 e1000_configure_kmrn_for_1000(struct e1000_hw *hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   147
static s32 e1000_do_read_eeprom(struct e1000_hw *hw, u16 offset, u16 words, u16 *data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   148
static s32 e1000_do_write_eeprom(struct e1000_hw *hw, u16 offset, u16 words, u16 *data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   149
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   150
/* IGP cable length table */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   151
static const
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   152
u16 e1000_igp_cable_length_table[IGP01E1000_AGC_LENGTH_TABLE_SIZE] =
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   153
    { 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   154
      5, 10, 10, 10, 10, 10, 10, 10, 20, 20, 20, 20, 20, 25, 25, 25,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   155
      25, 25, 25, 25, 30, 30, 30, 30, 40, 40, 40, 40, 40, 40, 40, 40,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   156
      40, 50, 50, 50, 50, 50, 50, 50, 60, 60, 60, 60, 60, 60, 60, 60,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   157
      60, 70, 70, 70, 70, 70, 70, 80, 80, 80, 80, 80, 80, 90, 90, 90,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   158
      90, 90, 90, 90, 90, 90, 100, 100, 100, 100, 100, 100, 100, 100, 100, 100,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   159
      100, 100, 100, 100, 110, 110, 110, 110, 110, 110, 110, 110, 110, 110, 110, 110,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   160
      110, 110, 110, 110, 110, 110, 120, 120, 120, 120, 120, 120, 120, 120, 120, 120};
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   161
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   162
static const
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   163
u16 e1000_igp_2_cable_length_table[IGP02E1000_AGC_LENGTH_TABLE_SIZE] =
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   164
    { 0, 0, 0, 0, 0, 0, 0, 0, 3, 5, 8, 11, 13, 16, 18, 21,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   165
      0, 0, 0, 3, 6, 10, 13, 16, 19, 23, 26, 29, 32, 35, 38, 41,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   166
      6, 10, 14, 18, 22, 26, 30, 33, 37, 41, 44, 48, 51, 54, 58, 61,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   167
      21, 26, 31, 35, 40, 44, 49, 53, 57, 61, 65, 68, 72, 75, 79, 82,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   168
      40, 45, 51, 56, 61, 66, 70, 75, 79, 83, 87, 91, 94, 98, 101, 104,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   169
      60, 66, 72, 77, 82, 87, 92, 96, 100, 104, 108, 111, 114, 117, 119, 121,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   170
      83, 89, 95, 100, 105, 109, 113, 116, 119, 122, 124,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   171
      104, 109, 114, 118, 121, 124};
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   172
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   173
static DEFINE_SPINLOCK(e1000_eeprom_lock);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   174
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   175
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   176
 * Set the phy type member in the hw struct.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   177
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   178
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   179
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   180
static s32 e1000_set_phy_type(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   181
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   182
    DEBUGFUNC("e1000_set_phy_type");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   183
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   184
    if (hw->mac_type == e1000_undefined)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   185
        return -E1000_ERR_PHY_TYPE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   186
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   187
    switch (hw->phy_id) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   188
    case M88E1000_E_PHY_ID:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   189
    case M88E1000_I_PHY_ID:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   190
    case M88E1011_I_PHY_ID:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   191
    case M88E1111_I_PHY_ID:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   192
        hw->phy_type = e1000_phy_m88;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   193
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   194
    case IGP01E1000_I_PHY_ID:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   195
        if (hw->mac_type == e1000_82541 ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   196
            hw->mac_type == e1000_82541_rev_2 ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   197
            hw->mac_type == e1000_82547 ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   198
            hw->mac_type == e1000_82547_rev_2) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   199
            hw->phy_type = e1000_phy_igp;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   200
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   201
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   202
    case IGP03E1000_E_PHY_ID:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   203
        hw->phy_type = e1000_phy_igp_3;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   204
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   205
    case IFE_E_PHY_ID:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   206
    case IFE_PLUS_E_PHY_ID:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   207
    case IFE_C_E_PHY_ID:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   208
        hw->phy_type = e1000_phy_ife;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   209
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   210
    case GG82563_E_PHY_ID:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   211
        if (hw->mac_type == e1000_80003es2lan) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   212
            hw->phy_type = e1000_phy_gg82563;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   213
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   214
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   215
        /* Fall Through */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   216
    default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   217
        /* Should never have loaded on this device */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   218
        hw->phy_type = e1000_phy_undefined;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   219
        return -E1000_ERR_PHY_TYPE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   220
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   221
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   222
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   223
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   224
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   225
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   226
 * IGP phy init script - initializes the GbE PHY
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   227
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   228
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   229
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   230
static void e1000_phy_init_script(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   231
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   232
    u32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   233
    u16 phy_saved_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   234
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   235
    DEBUGFUNC("e1000_phy_init_script");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   236
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   237
    if (hw->phy_init_script) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   238
        msleep(20);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   239
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   240
        /* Save off the current value of register 0x2F5B to be restored at
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   241
         * the end of this routine. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   242
        ret_val = e1000_read_phy_reg(hw, 0x2F5B, &phy_saved_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   243
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   244
        /* Disabled the PHY transmitter */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   245
        e1000_write_phy_reg(hw, 0x2F5B, 0x0003);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   246
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   247
        msleep(20);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   248
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   249
        e1000_write_phy_reg(hw,0x0000,0x0140);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   250
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   251
        msleep(5);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   252
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   253
        switch (hw->mac_type) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   254
        case e1000_82541:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   255
        case e1000_82547:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   256
            e1000_write_phy_reg(hw, 0x1F95, 0x0001);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   257
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   258
            e1000_write_phy_reg(hw, 0x1F71, 0xBD21);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   259
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   260
            e1000_write_phy_reg(hw, 0x1F79, 0x0018);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   261
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   262
            e1000_write_phy_reg(hw, 0x1F30, 0x1600);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   263
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   264
            e1000_write_phy_reg(hw, 0x1F31, 0x0014);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   265
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   266
            e1000_write_phy_reg(hw, 0x1F32, 0x161C);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   267
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   268
            e1000_write_phy_reg(hw, 0x1F94, 0x0003);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   269
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   270
            e1000_write_phy_reg(hw, 0x1F96, 0x003F);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   271
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   272
            e1000_write_phy_reg(hw, 0x2010, 0x0008);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   273
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   274
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   275
        case e1000_82541_rev_2:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   276
        case e1000_82547_rev_2:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   277
            e1000_write_phy_reg(hw, 0x1F73, 0x0099);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   278
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   279
        default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   280
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   281
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   282
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   283
        e1000_write_phy_reg(hw, 0x0000, 0x3300);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   284
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   285
        msleep(20);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   286
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   287
        /* Now enable the transmitter */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   288
        e1000_write_phy_reg(hw, 0x2F5B, phy_saved_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   289
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   290
        if (hw->mac_type == e1000_82547) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   291
            u16 fused, fine, coarse;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   292
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   293
            /* Move to analog registers page */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   294
            e1000_read_phy_reg(hw, IGP01E1000_ANALOG_SPARE_FUSE_STATUS, &fused);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   295
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   296
            if (!(fused & IGP01E1000_ANALOG_SPARE_FUSE_ENABLED)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   297
                e1000_read_phy_reg(hw, IGP01E1000_ANALOG_FUSE_STATUS, &fused);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   298
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   299
                fine = fused & IGP01E1000_ANALOG_FUSE_FINE_MASK;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   300
                coarse = fused & IGP01E1000_ANALOG_FUSE_COARSE_MASK;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   301
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   302
                if (coarse > IGP01E1000_ANALOG_FUSE_COARSE_THRESH) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   303
                    coarse -= IGP01E1000_ANALOG_FUSE_COARSE_10;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   304
                    fine -= IGP01E1000_ANALOG_FUSE_FINE_1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   305
                } else if (coarse == IGP01E1000_ANALOG_FUSE_COARSE_THRESH)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   306
                    fine -= IGP01E1000_ANALOG_FUSE_FINE_10;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   307
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   308
                fused = (fused & IGP01E1000_ANALOG_FUSE_POLY_MASK) |
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   309
                        (fine & IGP01E1000_ANALOG_FUSE_FINE_MASK) |
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   310
                        (coarse & IGP01E1000_ANALOG_FUSE_COARSE_MASK);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   311
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   312
                e1000_write_phy_reg(hw, IGP01E1000_ANALOG_FUSE_CONTROL, fused);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   313
                e1000_write_phy_reg(hw, IGP01E1000_ANALOG_FUSE_BYPASS,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   314
                                    IGP01E1000_ANALOG_FUSE_ENABLE_SW_CONTROL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   315
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   316
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   317
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   318
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   319
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   320
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   321
 * Set the mac type member in the hw struct.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   322
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   323
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   324
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   325
s32 e1000_set_mac_type(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   326
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   327
	DEBUGFUNC("e1000_set_mac_type");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   328
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   329
	switch (hw->device_id) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   330
	case E1000_DEV_ID_82542:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   331
		switch (hw->revision_id) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   332
		case E1000_82542_2_0_REV_ID:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   333
			hw->mac_type = e1000_82542_rev2_0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   334
			break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   335
		case E1000_82542_2_1_REV_ID:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   336
			hw->mac_type = e1000_82542_rev2_1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   337
			break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   338
		default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   339
			/* Invalid 82542 revision ID */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   340
			return -E1000_ERR_MAC_TYPE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   341
		}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   342
		break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   343
	case E1000_DEV_ID_82543GC_FIBER:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   344
	case E1000_DEV_ID_82543GC_COPPER:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   345
		hw->mac_type = e1000_82543;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   346
		break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   347
	case E1000_DEV_ID_82544EI_COPPER:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   348
	case E1000_DEV_ID_82544EI_FIBER:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   349
	case E1000_DEV_ID_82544GC_COPPER:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   350
	case E1000_DEV_ID_82544GC_LOM:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   351
		hw->mac_type = e1000_82544;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   352
		break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   353
	case E1000_DEV_ID_82540EM:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   354
	case E1000_DEV_ID_82540EM_LOM:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   355
	case E1000_DEV_ID_82540EP:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   356
	case E1000_DEV_ID_82540EP_LOM:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   357
	case E1000_DEV_ID_82540EP_LP:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   358
		hw->mac_type = e1000_82540;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   359
		break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   360
	case E1000_DEV_ID_82545EM_COPPER:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   361
	case E1000_DEV_ID_82545EM_FIBER:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   362
		hw->mac_type = e1000_82545;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   363
		break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   364
	case E1000_DEV_ID_82545GM_COPPER:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   365
	case E1000_DEV_ID_82545GM_FIBER:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   366
	case E1000_DEV_ID_82545GM_SERDES:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   367
		hw->mac_type = e1000_82545_rev_3;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   368
		break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   369
	case E1000_DEV_ID_82546EB_COPPER:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   370
	case E1000_DEV_ID_82546EB_FIBER:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   371
	case E1000_DEV_ID_82546EB_QUAD_COPPER:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   372
		hw->mac_type = e1000_82546;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   373
		break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   374
	case E1000_DEV_ID_82546GB_COPPER:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   375
	case E1000_DEV_ID_82546GB_FIBER:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   376
	case E1000_DEV_ID_82546GB_SERDES:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   377
	case E1000_DEV_ID_82546GB_PCIE:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   378
	case E1000_DEV_ID_82546GB_QUAD_COPPER:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   379
	case E1000_DEV_ID_82546GB_QUAD_COPPER_KSP3:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   380
		hw->mac_type = e1000_82546_rev_3;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   381
		break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   382
	case E1000_DEV_ID_82541EI:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   383
	case E1000_DEV_ID_82541EI_MOBILE:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   384
	case E1000_DEV_ID_82541ER_LOM:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   385
		hw->mac_type = e1000_82541;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   386
		break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   387
	case E1000_DEV_ID_82541ER:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   388
	case E1000_DEV_ID_82541GI:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   389
	case E1000_DEV_ID_82541GI_LF:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   390
	case E1000_DEV_ID_82541GI_MOBILE:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   391
		hw->mac_type = e1000_82541_rev_2;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   392
		break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   393
	case E1000_DEV_ID_82547EI:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   394
	case E1000_DEV_ID_82547EI_MOBILE:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   395
		hw->mac_type = e1000_82547;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   396
		break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   397
	case E1000_DEV_ID_82547GI:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   398
		hw->mac_type = e1000_82547_rev_2;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   399
		break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   400
	case E1000_DEV_ID_82571EB_COPPER:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   401
	case E1000_DEV_ID_82571EB_FIBER:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   402
	case E1000_DEV_ID_82571EB_SERDES:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   403
	case E1000_DEV_ID_82571EB_SERDES_DUAL:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   404
	case E1000_DEV_ID_82571EB_SERDES_QUAD:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   405
	case E1000_DEV_ID_82571EB_QUAD_COPPER:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   406
	case E1000_DEV_ID_82571PT_QUAD_COPPER:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   407
	case E1000_DEV_ID_82571EB_QUAD_FIBER:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   408
	case E1000_DEV_ID_82571EB_QUAD_COPPER_LOWPROFILE:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   409
		hw->mac_type = e1000_82571;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   410
		break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   411
	case E1000_DEV_ID_82572EI_COPPER:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   412
	case E1000_DEV_ID_82572EI_FIBER:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   413
	case E1000_DEV_ID_82572EI_SERDES:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   414
	case E1000_DEV_ID_82572EI:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   415
		hw->mac_type = e1000_82572;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   416
		break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   417
	case E1000_DEV_ID_82573E:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   418
	case E1000_DEV_ID_82573E_IAMT:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   419
	case E1000_DEV_ID_82573L:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   420
		hw->mac_type = e1000_82573;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   421
		break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   422
	case E1000_DEV_ID_80003ES2LAN_COPPER_SPT:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   423
	case E1000_DEV_ID_80003ES2LAN_SERDES_SPT:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   424
	case E1000_DEV_ID_80003ES2LAN_COPPER_DPT:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   425
	case E1000_DEV_ID_80003ES2LAN_SERDES_DPT:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   426
		hw->mac_type = e1000_80003es2lan;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   427
		break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   428
	case E1000_DEV_ID_ICH8_IGP_M_AMT:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   429
	case E1000_DEV_ID_ICH8_IGP_AMT:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   430
	case E1000_DEV_ID_ICH8_IGP_C:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   431
	case E1000_DEV_ID_ICH8_IFE:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   432
	case E1000_DEV_ID_ICH8_IFE_GT:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   433
	case E1000_DEV_ID_ICH8_IFE_G:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   434
	case E1000_DEV_ID_ICH8_IGP_M:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   435
		hw->mac_type = e1000_ich8lan;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   436
		break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   437
	default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   438
		/* Should never have loaded on this device */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   439
		return -E1000_ERR_MAC_TYPE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   440
	}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   441
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   442
	switch (hw->mac_type) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   443
	case e1000_ich8lan:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   444
		hw->swfwhw_semaphore_present = true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   445
		hw->asf_firmware_present = true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   446
		break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   447
	case e1000_80003es2lan:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   448
		hw->swfw_sync_present = true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   449
		/* fall through */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   450
	case e1000_82571:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   451
	case e1000_82572:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   452
	case e1000_82573:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   453
		hw->eeprom_semaphore_present = true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   454
		/* fall through */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   455
	case e1000_82541:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   456
	case e1000_82547:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   457
	case e1000_82541_rev_2:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   458
	case e1000_82547_rev_2:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   459
		hw->asf_firmware_present = true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   460
		break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   461
	default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   462
		break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   463
	}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   464
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   465
	/* The 82543 chip does not count tx_carrier_errors properly in
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   466
	 * FD mode
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   467
	 */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   468
	if (hw->mac_type == e1000_82543)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   469
		hw->bad_tx_carr_stats_fd = true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   470
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   471
	/* capable of receiving management packets to the host */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   472
	if (hw->mac_type >= e1000_82571)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   473
		hw->has_manc2h = true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   474
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   475
	/* In rare occasions, ESB2 systems would end up started without
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   476
	 * the RX unit being turned on.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   477
	 */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   478
	if (hw->mac_type == e1000_80003es2lan)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   479
		hw->rx_needs_kicking = true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   480
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   481
	if (hw->mac_type > e1000_82544)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   482
		hw->has_smbus = true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   483
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   484
	return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   485
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   486
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   487
/*****************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   488
 * Set media type and TBI compatibility.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   489
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   490
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   491
 * **************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   492
void e1000_set_media_type(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   493
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   494
    u32 status;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   495
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   496
    DEBUGFUNC("e1000_set_media_type");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   497
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   498
    if (hw->mac_type != e1000_82543) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   499
        /* tbi_compatibility is only valid on 82543 */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   500
        hw->tbi_compatibility_en = false;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   501
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   502
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   503
    switch (hw->device_id) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   504
    case E1000_DEV_ID_82545GM_SERDES:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   505
    case E1000_DEV_ID_82546GB_SERDES:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   506
    case E1000_DEV_ID_82571EB_SERDES:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   507
    case E1000_DEV_ID_82571EB_SERDES_DUAL:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   508
    case E1000_DEV_ID_82571EB_SERDES_QUAD:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   509
    case E1000_DEV_ID_82572EI_SERDES:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   510
    case E1000_DEV_ID_80003ES2LAN_SERDES_DPT:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   511
        hw->media_type = e1000_media_type_internal_serdes;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   512
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   513
    default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   514
        switch (hw->mac_type) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   515
        case e1000_82542_rev2_0:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   516
        case e1000_82542_rev2_1:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   517
            hw->media_type = e1000_media_type_fiber;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   518
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   519
        case e1000_ich8lan:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   520
        case e1000_82573:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   521
            /* The STATUS_TBIMODE bit is reserved or reused for the this
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   522
             * device.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   523
             */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   524
            hw->media_type = e1000_media_type_copper;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   525
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   526
        default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   527
            status = er32(STATUS);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   528
            if (status & E1000_STATUS_TBIMODE) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   529
                hw->media_type = e1000_media_type_fiber;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   530
                /* tbi_compatibility not valid on fiber */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   531
                hw->tbi_compatibility_en = false;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   532
            } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   533
                hw->media_type = e1000_media_type_copper;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   534
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   535
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   536
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   537
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   538
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   539
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   540
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   541
 * Reset the transmit and receive units; mask and clear all interrupts.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   542
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   543
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   544
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   545
s32 e1000_reset_hw(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   546
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   547
    u32 ctrl;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   548
    u32 ctrl_ext;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   549
    u32 icr;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   550
    u32 manc;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   551
    u32 led_ctrl;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   552
    u32 timeout;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   553
    u32 extcnf_ctrl;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   554
    s32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   555
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   556
    DEBUGFUNC("e1000_reset_hw");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   557
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   558
    /* For 82542 (rev 2.0), disable MWI before issuing a device reset */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   559
    if (hw->mac_type == e1000_82542_rev2_0) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   560
        DEBUGOUT("Disabling MWI on 82542 rev 2.0\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   561
        e1000_pci_clear_mwi(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   562
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   563
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   564
    if (hw->bus_type == e1000_bus_type_pci_express) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   565
        /* Prevent the PCI-E bus from sticking if there is no TLP connection
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   566
         * on the last TLP read/write transaction when MAC is reset.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   567
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   568
        if (e1000_disable_pciex_master(hw) != E1000_SUCCESS) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   569
            DEBUGOUT("PCI-E Master disable polling has failed.\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   570
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   571
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   572
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   573
    /* Clear interrupt mask to stop board from generating interrupts */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   574
    DEBUGOUT("Masking off all interrupts\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   575
    ew32(IMC, 0xffffffff);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   576
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   577
    /* Disable the Transmit and Receive units.  Then delay to allow
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   578
     * any pending transactions to complete before we hit the MAC with
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   579
     * the global reset.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   580
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   581
    ew32(RCTL, 0);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   582
    ew32(TCTL, E1000_TCTL_PSP);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   583
    E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   584
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   585
    /* The tbi_compatibility_on Flag must be cleared when Rctl is cleared. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   586
    hw->tbi_compatibility_on = false;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   587
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   588
    /* Delay to allow any outstanding PCI transactions to complete before
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   589
     * resetting the device
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   590
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   591
    msleep(10);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   592
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   593
    ctrl = er32(CTRL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   594
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   595
    /* Must reset the PHY before resetting the MAC */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   596
    if ((hw->mac_type == e1000_82541) || (hw->mac_type == e1000_82547)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   597
        ew32(CTRL, (ctrl | E1000_CTRL_PHY_RST));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   598
        msleep(5);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   599
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   600
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   601
    /* Must acquire the MDIO ownership before MAC reset.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   602
     * Ownership defaults to firmware after a reset. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   603
    if (hw->mac_type == e1000_82573) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   604
        timeout = 10;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   605
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   606
        extcnf_ctrl = er32(EXTCNF_CTRL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   607
        extcnf_ctrl |= E1000_EXTCNF_CTRL_MDIO_SW_OWNERSHIP;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   608
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   609
        do {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   610
            ew32(EXTCNF_CTRL, extcnf_ctrl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   611
            extcnf_ctrl = er32(EXTCNF_CTRL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   612
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   613
            if (extcnf_ctrl & E1000_EXTCNF_CTRL_MDIO_SW_OWNERSHIP)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   614
                break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   615
            else
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   616
                extcnf_ctrl |= E1000_EXTCNF_CTRL_MDIO_SW_OWNERSHIP;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   617
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   618
            msleep(2);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   619
            timeout--;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   620
        } while (timeout);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   621
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   622
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   623
    /* Workaround for ICH8 bit corruption issue in FIFO memory */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   624
    if (hw->mac_type == e1000_ich8lan) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   625
        /* Set Tx and Rx buffer allocation to 8k apiece. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   626
        ew32(PBA, E1000_PBA_8K);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   627
        /* Set Packet Buffer Size to 16k. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   628
        ew32(PBS, E1000_PBS_16K);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   629
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   630
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   631
    /* Issue a global reset to the MAC.  This will reset the chip's
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   632
     * transmit, receive, DMA, and link units.  It will not effect
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   633
     * the current PCI configuration.  The global reset bit is self-
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   634
     * clearing, and should clear within a microsecond.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   635
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   636
    DEBUGOUT("Issuing a global reset to MAC\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   637
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   638
    switch (hw->mac_type) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   639
        case e1000_82544:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   640
        case e1000_82540:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   641
        case e1000_82545:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   642
        case e1000_82546:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   643
        case e1000_82541:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   644
        case e1000_82541_rev_2:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   645
            /* These controllers can't ack the 64-bit write when issuing the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   646
             * reset, so use IO-mapping as a workaround to issue the reset */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   647
            E1000_WRITE_REG_IO(hw, CTRL, (ctrl | E1000_CTRL_RST));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   648
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   649
        case e1000_82545_rev_3:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   650
        case e1000_82546_rev_3:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   651
            /* Reset is performed on a shadow of the control register */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   652
            ew32(CTRL_DUP, (ctrl | E1000_CTRL_RST));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   653
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   654
        case e1000_ich8lan:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   655
            if (!hw->phy_reset_disable &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   656
                e1000_check_phy_reset_block(hw) == E1000_SUCCESS) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   657
                /* e1000_ich8lan PHY HW reset requires MAC CORE reset
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   658
                 * at the same time to make sure the interface between
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   659
                 * MAC and the external PHY is reset.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   660
                 */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   661
                ctrl |= E1000_CTRL_PHY_RST;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   662
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   663
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   664
            e1000_get_software_flag(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   665
            ew32(CTRL, (ctrl | E1000_CTRL_RST));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   666
            msleep(5);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   667
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   668
        default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   669
            ew32(CTRL, (ctrl | E1000_CTRL_RST));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   670
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   671
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   672
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   673
    /* After MAC reset, force reload of EEPROM to restore power-on settings to
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   674
     * device.  Later controllers reload the EEPROM automatically, so just wait
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   675
     * for reload to complete.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   676
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   677
    switch (hw->mac_type) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   678
        case e1000_82542_rev2_0:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   679
        case e1000_82542_rev2_1:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   680
        case e1000_82543:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   681
        case e1000_82544:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   682
            /* Wait for reset to complete */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   683
            udelay(10);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   684
            ctrl_ext = er32(CTRL_EXT);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   685
            ctrl_ext |= E1000_CTRL_EXT_EE_RST;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   686
            ew32(CTRL_EXT, ctrl_ext);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   687
            E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   688
            /* Wait for EEPROM reload */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   689
            msleep(2);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   690
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   691
        case e1000_82541:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   692
        case e1000_82541_rev_2:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   693
        case e1000_82547:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   694
        case e1000_82547_rev_2:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   695
            /* Wait for EEPROM reload */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   696
            msleep(20);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   697
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   698
        case e1000_82573:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   699
            if (!e1000_is_onboard_nvm_eeprom(hw)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   700
                udelay(10);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   701
                ctrl_ext = er32(CTRL_EXT);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   702
                ctrl_ext |= E1000_CTRL_EXT_EE_RST;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   703
                ew32(CTRL_EXT, ctrl_ext);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   704
                E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   705
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   706
            /* fall through */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   707
        default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   708
            /* Auto read done will delay 5ms or poll based on mac type */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   709
            ret_val = e1000_get_auto_rd_done(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   710
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   711
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   712
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   713
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   714
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   715
    /* Disable HW ARPs on ASF enabled adapters */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   716
    if (hw->mac_type >= e1000_82540 && hw->mac_type <= e1000_82547_rev_2) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   717
        manc = er32(MANC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   718
        manc &= ~(E1000_MANC_ARP_EN);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   719
        ew32(MANC, manc);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   720
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   721
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   722
    if ((hw->mac_type == e1000_82541) || (hw->mac_type == e1000_82547)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   723
        e1000_phy_init_script(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   724
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   725
        /* Configure activity LED after PHY reset */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   726
        led_ctrl = er32(LEDCTL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   727
        led_ctrl &= IGP_ACTIVITY_LED_MASK;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   728
        led_ctrl |= (IGP_ACTIVITY_LED_ENABLE | IGP_LED3_MODE);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   729
        ew32(LEDCTL, led_ctrl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   730
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   731
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   732
    /* Clear interrupt mask to stop board from generating interrupts */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   733
    DEBUGOUT("Masking off all interrupts\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   734
    ew32(IMC, 0xffffffff);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   735
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   736
    /* Clear any pending interrupt events. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   737
    icr = er32(ICR);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   738
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   739
    /* If MWI was previously enabled, reenable it. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   740
    if (hw->mac_type == e1000_82542_rev2_0) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   741
        if (hw->pci_cmd_word & PCI_COMMAND_INVALIDATE)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   742
            e1000_pci_set_mwi(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   743
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   744
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   745
    if (hw->mac_type == e1000_ich8lan) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   746
        u32 kab = er32(KABGTXD);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   747
        kab |= E1000_KABGTXD_BGSQLBIAS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   748
        ew32(KABGTXD, kab);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   749
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   750
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   751
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   752
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   753
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   754
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   755
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   756
 * Initialize a number of hardware-dependent bits
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   757
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   758
 * hw: Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   759
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   760
 * This function contains hardware limitation workarounds for PCI-E adapters
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   761
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   762
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   763
static void e1000_initialize_hardware_bits(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   764
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   765
    if ((hw->mac_type >= e1000_82571) && (!hw->initialize_hw_bits_disable)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   766
        /* Settings common to all PCI-express silicon */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   767
        u32 reg_ctrl, reg_ctrl_ext;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   768
        u32 reg_tarc0, reg_tarc1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   769
        u32 reg_tctl;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   770
        u32 reg_txdctl, reg_txdctl1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   771
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   772
        /* link autonegotiation/sync workarounds */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   773
        reg_tarc0 = er32(TARC0);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   774
        reg_tarc0 &= ~((1 << 30)|(1 << 29)|(1 << 28)|(1 << 27));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   775
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   776
        /* Enable not-done TX descriptor counting */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   777
        reg_txdctl = er32(TXDCTL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   778
        reg_txdctl |= E1000_TXDCTL_COUNT_DESC;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   779
        ew32(TXDCTL, reg_txdctl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   780
        reg_txdctl1 = er32(TXDCTL1);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   781
        reg_txdctl1 |= E1000_TXDCTL_COUNT_DESC;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   782
        ew32(TXDCTL1, reg_txdctl1);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   783
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   784
        switch (hw->mac_type) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   785
            case e1000_82571:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   786
            case e1000_82572:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   787
                /* Clear PHY TX compatible mode bits */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   788
                reg_tarc1 = er32(TARC1);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   789
                reg_tarc1 &= ~((1 << 30)|(1 << 29));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   790
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   791
                /* link autonegotiation/sync workarounds */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   792
                reg_tarc0 |= ((1 << 26)|(1 << 25)|(1 << 24)|(1 << 23));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   793
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   794
                /* TX ring control fixes */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   795
                reg_tarc1 |= ((1 << 26)|(1 << 25)|(1 << 24));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   796
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   797
                /* Multiple read bit is reversed polarity */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   798
                reg_tctl = er32(TCTL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   799
                if (reg_tctl & E1000_TCTL_MULR)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   800
                    reg_tarc1 &= ~(1 << 28);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   801
                else
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   802
                    reg_tarc1 |= (1 << 28);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   803
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   804
                ew32(TARC1, reg_tarc1);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   805
                break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   806
            case e1000_82573:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   807
                reg_ctrl_ext = er32(CTRL_EXT);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   808
                reg_ctrl_ext &= ~(1 << 23);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   809
                reg_ctrl_ext |= (1 << 22);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   810
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   811
                /* TX byte count fix */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   812
                reg_ctrl = er32(CTRL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   813
                reg_ctrl &= ~(1 << 29);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   814
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   815
                ew32(CTRL_EXT, reg_ctrl_ext);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   816
                ew32(CTRL, reg_ctrl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   817
                break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   818
            case e1000_80003es2lan:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   819
                /* improve small packet performace for fiber/serdes */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   820
                if ((hw->media_type == e1000_media_type_fiber) ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   821
                    (hw->media_type == e1000_media_type_internal_serdes)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   822
                    reg_tarc0 &= ~(1 << 20);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   823
                }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   824
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   825
                /* Multiple read bit is reversed polarity */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   826
                reg_tctl = er32(TCTL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   827
                reg_tarc1 = er32(TARC1);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   828
                if (reg_tctl & E1000_TCTL_MULR)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   829
                    reg_tarc1 &= ~(1 << 28);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   830
                else
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   831
                    reg_tarc1 |= (1 << 28);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   832
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   833
                ew32(TARC1, reg_tarc1);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   834
                break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   835
            case e1000_ich8lan:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   836
                /* Reduce concurrent DMA requests to 3 from 4 */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   837
                if ((hw->revision_id < 3) ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   838
                    ((hw->device_id != E1000_DEV_ID_ICH8_IGP_M_AMT) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   839
                     (hw->device_id != E1000_DEV_ID_ICH8_IGP_M)))
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   840
                    reg_tarc0 |= ((1 << 29)|(1 << 28));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   841
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   842
                reg_ctrl_ext = er32(CTRL_EXT);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   843
                reg_ctrl_ext |= (1 << 22);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   844
                ew32(CTRL_EXT, reg_ctrl_ext);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   845
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   846
                /* workaround TX hang with TSO=on */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   847
                reg_tarc0 |= ((1 << 27)|(1 << 26)|(1 << 24)|(1 << 23));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   848
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   849
                /* Multiple read bit is reversed polarity */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   850
                reg_tctl = er32(TCTL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   851
                reg_tarc1 = er32(TARC1);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   852
                if (reg_tctl & E1000_TCTL_MULR)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   853
                    reg_tarc1 &= ~(1 << 28);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   854
                else
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   855
                    reg_tarc1 |= (1 << 28);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   856
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   857
                /* workaround TX hang with TSO=on */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   858
                reg_tarc1 |= ((1 << 30)|(1 << 26)|(1 << 24));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   859
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   860
                ew32(TARC1, reg_tarc1);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   861
                break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   862
            default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   863
                break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   864
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   865
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   866
        ew32(TARC0, reg_tarc0);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   867
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   868
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   869
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   870
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   871
 * Performs basic configuration of the adapter.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   872
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   873
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   874
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   875
 * Assumes that the controller has previously been reset and is in a
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   876
 * post-reset uninitialized state. Initializes the receive address registers,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   877
 * multicast table, and VLAN filter table. Calls routines to setup link
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   878
 * configuration and flow control settings. Clears all on-chip counters. Leaves
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   879
 * the transmit and receive units disabled and uninitialized.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   880
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   881
s32 e1000_init_hw(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   882
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   883
    u32 ctrl;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   884
    u32 i;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   885
    s32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   886
    u32 mta_size;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   887
    u32 reg_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   888
    u32 ctrl_ext;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   889
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   890
    DEBUGFUNC("e1000_init_hw");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   891
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   892
    /* force full DMA clock frequency for 10/100 on ICH8 A0-B0 */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   893
    if ((hw->mac_type == e1000_ich8lan) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   894
        ((hw->revision_id < 3) ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   895
         ((hw->device_id != E1000_DEV_ID_ICH8_IGP_M_AMT) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   896
          (hw->device_id != E1000_DEV_ID_ICH8_IGP_M)))) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   897
            reg_data = er32(STATUS);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   898
            reg_data &= ~0x80000000;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   899
            ew32(STATUS, reg_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   900
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   901
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   902
    /* Initialize Identification LED */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   903
    ret_val = e1000_id_led_init(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   904
    if (ret_val) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   905
        DEBUGOUT("Error Initializing Identification LED\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   906
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   907
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   908
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   909
    /* Set the media type and TBI compatibility */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   910
    e1000_set_media_type(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   911
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   912
    /* Must be called after e1000_set_media_type because media_type is used */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   913
    e1000_initialize_hardware_bits(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   914
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   915
    /* Disabling VLAN filtering. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   916
    DEBUGOUT("Initializing the IEEE VLAN\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   917
    /* VET hardcoded to standard value and VFTA removed in ICH8 LAN */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   918
    if (hw->mac_type != e1000_ich8lan) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   919
        if (hw->mac_type < e1000_82545_rev_3)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   920
            ew32(VET, 0);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   921
        e1000_clear_vfta(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   922
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   923
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   924
    /* For 82542 (rev 2.0), disable MWI and put the receiver into reset */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   925
    if (hw->mac_type == e1000_82542_rev2_0) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   926
        DEBUGOUT("Disabling MWI on 82542 rev 2.0\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   927
        e1000_pci_clear_mwi(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   928
        ew32(RCTL, E1000_RCTL_RST);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   929
        E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   930
        msleep(5);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   931
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   932
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   933
    /* Setup the receive address. This involves initializing all of the Receive
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   934
     * Address Registers (RARs 0 - 15).
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   935
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   936
    e1000_init_rx_addrs(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   937
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   938
    /* For 82542 (rev 2.0), take the receiver out of reset and enable MWI */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   939
    if (hw->mac_type == e1000_82542_rev2_0) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   940
        ew32(RCTL, 0);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   941
        E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   942
        msleep(1);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   943
        if (hw->pci_cmd_word & PCI_COMMAND_INVALIDATE)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   944
            e1000_pci_set_mwi(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   945
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   946
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   947
    /* Zero out the Multicast HASH table */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   948
    DEBUGOUT("Zeroing the MTA\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   949
    mta_size = E1000_MC_TBL_SIZE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   950
    if (hw->mac_type == e1000_ich8lan)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   951
        mta_size = E1000_MC_TBL_SIZE_ICH8LAN;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   952
    for (i = 0; i < mta_size; i++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   953
        E1000_WRITE_REG_ARRAY(hw, MTA, i, 0);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   954
        /* use write flush to prevent Memory Write Block (MWB) from
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   955
         * occuring when accessing our register space */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   956
        E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   957
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   958
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   959
    /* Set the PCI priority bit correctly in the CTRL register.  This
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   960
     * determines if the adapter gives priority to receives, or if it
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   961
     * gives equal priority to transmits and receives.  Valid only on
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   962
     * 82542 and 82543 silicon.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   963
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   964
    if (hw->dma_fairness && hw->mac_type <= e1000_82543) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   965
        ctrl = er32(CTRL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   966
        ew32(CTRL, ctrl | E1000_CTRL_PRIOR);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   967
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   968
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   969
    switch (hw->mac_type) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   970
    case e1000_82545_rev_3:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   971
    case e1000_82546_rev_3:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   972
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   973
    default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   974
        /* Workaround for PCI-X problem when BIOS sets MMRBC incorrectly. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   975
	if (hw->bus_type == e1000_bus_type_pcix && e1000_pcix_get_mmrbc(hw) > 2048)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   976
		e1000_pcix_set_mmrbc(hw, 2048);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   977
	break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   978
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   979
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   980
    /* More time needed for PHY to initialize */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   981
    if (hw->mac_type == e1000_ich8lan)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   982
        msleep(15);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   983
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   984
    /* Call a subroutine to configure the link and setup flow control. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   985
    ret_val = e1000_setup_link(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   986
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   987
    /* Set the transmit descriptor write-back policy */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   988
    if (hw->mac_type > e1000_82544) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   989
        ctrl = er32(TXDCTL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   990
        ctrl = (ctrl & ~E1000_TXDCTL_WTHRESH) | E1000_TXDCTL_FULL_TX_DESC_WB;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   991
        ew32(TXDCTL, ctrl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   992
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   993
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   994
    if (hw->mac_type == e1000_82573) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   995
        e1000_enable_tx_pkt_filtering(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   996
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   997
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   998
    switch (hw->mac_type) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
   999
    default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1000
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1001
    case e1000_80003es2lan:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1002
        /* Enable retransmit on late collisions */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1003
        reg_data = er32(TCTL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1004
        reg_data |= E1000_TCTL_RTLC;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1005
        ew32(TCTL, reg_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1006
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1007
        /* Configure Gigabit Carry Extend Padding */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1008
        reg_data = er32(TCTL_EXT);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1009
        reg_data &= ~E1000_TCTL_EXT_GCEX_MASK;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1010
        reg_data |= DEFAULT_80003ES2LAN_TCTL_EXT_GCEX;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1011
        ew32(TCTL_EXT, reg_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1012
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1013
        /* Configure Transmit Inter-Packet Gap */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1014
        reg_data = er32(TIPG);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1015
        reg_data &= ~E1000_TIPG_IPGT_MASK;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1016
        reg_data |= DEFAULT_80003ES2LAN_TIPG_IPGT_1000;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1017
        ew32(TIPG, reg_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1018
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1019
        reg_data = E1000_READ_REG_ARRAY(hw, FFLT, 0x0001);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1020
        reg_data &= ~0x00100000;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1021
        E1000_WRITE_REG_ARRAY(hw, FFLT, 0x0001, reg_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1022
        /* Fall through */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1023
    case e1000_82571:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1024
    case e1000_82572:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1025
    case e1000_ich8lan:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1026
        ctrl = er32(TXDCTL1);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1027
        ctrl = (ctrl & ~E1000_TXDCTL_WTHRESH) | E1000_TXDCTL_FULL_TX_DESC_WB;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1028
        ew32(TXDCTL1, ctrl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1029
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1030
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1031
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1032
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1033
    if (hw->mac_type == e1000_82573) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1034
        u32 gcr = er32(GCR);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1035
        gcr |= E1000_GCR_L1_ACT_WITHOUT_L0S_RX;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1036
        ew32(GCR, gcr);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1037
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1038
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1039
    /* Clear all of the statistics registers (clear on read).  It is
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1040
     * important that we do this after we have tried to establish link
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1041
     * because the symbol error count will increment wildly if there
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1042
     * is no link.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1043
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1044
    e1000_clear_hw_cntrs(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1045
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1046
    /* ICH8 No-snoop bits are opposite polarity.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1047
     * Set to snoop by default after reset. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1048
    if (hw->mac_type == e1000_ich8lan)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1049
        e1000_set_pci_ex_no_snoop(hw, PCI_EX_82566_SNOOP_ALL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1050
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1051
    if (hw->device_id == E1000_DEV_ID_82546GB_QUAD_COPPER ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1052
        hw->device_id == E1000_DEV_ID_82546GB_QUAD_COPPER_KSP3) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1053
        ctrl_ext = er32(CTRL_EXT);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1054
        /* Relaxed ordering must be disabled to avoid a parity
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1055
         * error crash in a PCI slot. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1056
        ctrl_ext |= E1000_CTRL_EXT_RO_DIS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1057
        ew32(CTRL_EXT, ctrl_ext);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1058
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1059
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1060
    return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1061
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1062
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1063
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1064
 * Adjust SERDES output amplitude based on EEPROM setting.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1065
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1066
 * hw - Struct containing variables accessed by shared code.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1067
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1068
static s32 e1000_adjust_serdes_amplitude(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1069
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1070
    u16 eeprom_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1071
    s32  ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1072
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1073
    DEBUGFUNC("e1000_adjust_serdes_amplitude");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1074
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1075
    if (hw->media_type != e1000_media_type_internal_serdes)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1076
        return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1077
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1078
    switch (hw->mac_type) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1079
    case e1000_82545_rev_3:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1080
    case e1000_82546_rev_3:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1081
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1082
    default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1083
        return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1084
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1085
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1086
    ret_val = e1000_read_eeprom(hw, EEPROM_SERDES_AMPLITUDE, 1, &eeprom_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1087
    if (ret_val) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1088
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1089
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1090
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1091
    if (eeprom_data != EEPROM_RESERVED_WORD) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1092
        /* Adjust SERDES output amplitude only. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1093
        eeprom_data &= EEPROM_SERDES_AMPLITUDE_MASK;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1094
        ret_val = e1000_write_phy_reg(hw, M88E1000_PHY_EXT_CTRL, eeprom_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1095
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1096
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1097
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1098
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1099
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1100
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1101
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1102
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1103
 * Configures flow control and link settings.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1104
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1105
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1106
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1107
 * Determines which flow control settings to use. Calls the apropriate media-
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1108
 * specific link configuration function. Configures the flow control settings.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1109
 * Assuming the adapter has a valid link partner, a valid link should be
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1110
 * established. Assumes the hardware has previously been reset and the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1111
 * transmitter and receiver are not enabled.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1112
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1113
s32 e1000_setup_link(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1114
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1115
    u32 ctrl_ext;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1116
    s32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1117
    u16 eeprom_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1118
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1119
    DEBUGFUNC("e1000_setup_link");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1120
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1121
    /* In the case of the phy reset being blocked, we already have a link.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1122
     * We do not have to set it up again. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1123
    if (e1000_check_phy_reset_block(hw))
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1124
        return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1125
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1126
    /* Read and store word 0x0F of the EEPROM. This word contains bits
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1127
     * that determine the hardware's default PAUSE (flow control) mode,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1128
     * a bit that determines whether the HW defaults to enabling or
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1129
     * disabling auto-negotiation, and the direction of the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1130
     * SW defined pins. If there is no SW over-ride of the flow
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1131
     * control setting, then the variable hw->fc will
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1132
     * be initialized based on a value in the EEPROM.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1133
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1134
    if (hw->fc == E1000_FC_DEFAULT) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1135
        switch (hw->mac_type) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1136
        case e1000_ich8lan:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1137
        case e1000_82573:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1138
            hw->fc = E1000_FC_FULL;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1139
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1140
        default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1141
            ret_val = e1000_read_eeprom(hw, EEPROM_INIT_CONTROL2_REG,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1142
                                        1, &eeprom_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1143
            if (ret_val) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1144
                DEBUGOUT("EEPROM Read Error\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1145
                return -E1000_ERR_EEPROM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1146
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1147
            if ((eeprom_data & EEPROM_WORD0F_PAUSE_MASK) == 0)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1148
                hw->fc = E1000_FC_NONE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1149
            else if ((eeprom_data & EEPROM_WORD0F_PAUSE_MASK) ==
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1150
                    EEPROM_WORD0F_ASM_DIR)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1151
                hw->fc = E1000_FC_TX_PAUSE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1152
            else
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1153
                hw->fc = E1000_FC_FULL;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1154
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1155
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1156
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1157
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1158
    /* We want to save off the original Flow Control configuration just
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1159
     * in case we get disconnected and then reconnected into a different
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1160
     * hub or switch with different Flow Control capabilities.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1161
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1162
    if (hw->mac_type == e1000_82542_rev2_0)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1163
        hw->fc &= (~E1000_FC_TX_PAUSE);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1164
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1165
    if ((hw->mac_type < e1000_82543) && (hw->report_tx_early == 1))
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1166
        hw->fc &= (~E1000_FC_RX_PAUSE);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1167
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1168
    hw->original_fc = hw->fc;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1169
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1170
    DEBUGOUT1("After fix-ups FlowControl is now = %x\n", hw->fc);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1171
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1172
    /* Take the 4 bits from EEPROM word 0x0F that determine the initial
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1173
     * polarity value for the SW controlled pins, and setup the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1174
     * Extended Device Control reg with that info.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1175
     * This is needed because one of the SW controlled pins is used for
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1176
     * signal detection.  So this should be done before e1000_setup_pcs_link()
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1177
     * or e1000_phy_setup() is called.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1178
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1179
    if (hw->mac_type == e1000_82543) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1180
        ret_val = e1000_read_eeprom(hw, EEPROM_INIT_CONTROL2_REG,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1181
                                    1, &eeprom_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1182
        if (ret_val) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1183
            DEBUGOUT("EEPROM Read Error\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1184
            return -E1000_ERR_EEPROM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1185
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1186
        ctrl_ext = ((eeprom_data & EEPROM_WORD0F_SWPDIO_EXT) <<
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1187
                    SWDPIO__EXT_SHIFT);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1188
        ew32(CTRL_EXT, ctrl_ext);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1189
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1190
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1191
    /* Call the necessary subroutine to configure the link. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1192
    ret_val = (hw->media_type == e1000_media_type_copper) ?
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1193
              e1000_setup_copper_link(hw) :
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1194
              e1000_setup_fiber_serdes_link(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1195
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1196
    /* Initialize the flow control address, type, and PAUSE timer
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1197
     * registers to their default values.  This is done even if flow
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1198
     * control is disabled, because it does not hurt anything to
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1199
     * initialize these registers.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1200
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1201
    DEBUGOUT("Initializing the Flow Control address, type and timer regs\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1202
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1203
    /* FCAL/H and FCT are hardcoded to standard values in e1000_ich8lan. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1204
    if (hw->mac_type != e1000_ich8lan) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1205
        ew32(FCT, FLOW_CONTROL_TYPE);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1206
        ew32(FCAH, FLOW_CONTROL_ADDRESS_HIGH);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1207
        ew32(FCAL, FLOW_CONTROL_ADDRESS_LOW);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1208
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1209
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1210
    ew32(FCTTV, hw->fc_pause_time);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1211
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1212
    /* Set the flow control receive threshold registers.  Normally,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1213
     * these registers will be set to a default threshold that may be
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1214
     * adjusted later by the driver's runtime code.  However, if the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1215
     * ability to transmit pause frames in not enabled, then these
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1216
     * registers will be set to 0.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1217
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1218
    if (!(hw->fc & E1000_FC_TX_PAUSE)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1219
        ew32(FCRTL, 0);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1220
        ew32(FCRTH, 0);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1221
    } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1222
        /* We need to set up the Receive Threshold high and low water marks
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1223
         * as well as (optionally) enabling the transmission of XON frames.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1224
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1225
        if (hw->fc_send_xon) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1226
            ew32(FCRTL, (hw->fc_low_water | E1000_FCRTL_XONE));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1227
            ew32(FCRTH, hw->fc_high_water);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1228
        } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1229
            ew32(FCRTL, hw->fc_low_water);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1230
            ew32(FCRTH, hw->fc_high_water);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1231
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1232
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1233
    return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1234
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1235
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1236
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1237
 * Sets up link for a fiber based or serdes based adapter
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1238
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1239
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1240
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1241
 * Manipulates Physical Coding Sublayer functions in order to configure
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1242
 * link. Assumes the hardware has been previously reset and the transmitter
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1243
 * and receiver are not enabled.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1244
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1245
static s32 e1000_setup_fiber_serdes_link(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1246
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1247
    u32 ctrl;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1248
    u32 status;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1249
    u32 txcw = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1250
    u32 i;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1251
    u32 signal = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1252
    s32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1253
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1254
    DEBUGFUNC("e1000_setup_fiber_serdes_link");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1255
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1256
    /* On 82571 and 82572 Fiber connections, SerDes loopback mode persists
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1257
     * until explicitly turned off or a power cycle is performed.  A read to
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1258
     * the register does not indicate its status.  Therefore, we ensure
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1259
     * loopback mode is disabled during initialization.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1260
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1261
    if (hw->mac_type == e1000_82571 || hw->mac_type == e1000_82572)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1262
        ew32(SCTL, E1000_DISABLE_SERDES_LOOPBACK);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1263
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1264
    /* On adapters with a MAC newer than 82544, SWDP 1 will be
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1265
     * set when the optics detect a signal. On older adapters, it will be
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1266
     * cleared when there is a signal.  This applies to fiber media only.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1267
     * If we're on serdes media, adjust the output amplitude to value
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1268
     * set in the EEPROM.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1269
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1270
    ctrl = er32(CTRL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1271
    if (hw->media_type == e1000_media_type_fiber)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1272
        signal = (hw->mac_type > e1000_82544) ? E1000_CTRL_SWDPIN1 : 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1273
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1274
    ret_val = e1000_adjust_serdes_amplitude(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1275
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1276
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1277
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1278
    /* Take the link out of reset */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1279
    ctrl &= ~(E1000_CTRL_LRST);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1280
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1281
    /* Adjust VCO speed to improve BER performance */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1282
    ret_val = e1000_set_vco_speed(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1283
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1284
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1285
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1286
    e1000_config_collision_dist(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1287
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1288
    /* Check for a software override of the flow control settings, and setup
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1289
     * the device accordingly.  If auto-negotiation is enabled, then software
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1290
     * will have to set the "PAUSE" bits to the correct value in the Tranmsit
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1291
     * Config Word Register (TXCW) and re-start auto-negotiation.  However, if
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1292
     * auto-negotiation is disabled, then software will have to manually
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1293
     * configure the two flow control enable bits in the CTRL register.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1294
     *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1295
     * The possible values of the "fc" parameter are:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1296
     *      0:  Flow control is completely disabled
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1297
     *      1:  Rx flow control is enabled (we can receive pause frames, but
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1298
     *          not send pause frames).
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1299
     *      2:  Tx flow control is enabled (we can send pause frames but we do
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1300
     *          not support receiving pause frames).
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1301
     *      3:  Both Rx and TX flow control (symmetric) are enabled.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1302
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1303
    switch (hw->fc) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1304
    case E1000_FC_NONE:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1305
        /* Flow control is completely disabled by a software over-ride. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1306
        txcw = (E1000_TXCW_ANE | E1000_TXCW_FD);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1307
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1308
    case E1000_FC_RX_PAUSE:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1309
        /* RX Flow control is enabled and TX Flow control is disabled by a
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1310
         * software over-ride. Since there really isn't a way to advertise
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1311
         * that we are capable of RX Pause ONLY, we will advertise that we
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1312
         * support both symmetric and asymmetric RX PAUSE. Later, we will
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1313
         *  disable the adapter's ability to send PAUSE frames.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1314
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1315
        txcw = (E1000_TXCW_ANE | E1000_TXCW_FD | E1000_TXCW_PAUSE_MASK);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1316
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1317
    case E1000_FC_TX_PAUSE:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1318
        /* TX Flow control is enabled, and RX Flow control is disabled, by a
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1319
         * software over-ride.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1320
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1321
        txcw = (E1000_TXCW_ANE | E1000_TXCW_FD | E1000_TXCW_ASM_DIR);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1322
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1323
    case E1000_FC_FULL:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1324
        /* Flow control (both RX and TX) is enabled by a software over-ride. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1325
        txcw = (E1000_TXCW_ANE | E1000_TXCW_FD | E1000_TXCW_PAUSE_MASK);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1326
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1327
    default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1328
        DEBUGOUT("Flow control param set incorrectly\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1329
        return -E1000_ERR_CONFIG;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1330
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1331
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1332
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1333
    /* Since auto-negotiation is enabled, take the link out of reset (the link
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1334
     * will be in reset, because we previously reset the chip). This will
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1335
     * restart auto-negotiation.  If auto-neogtiation is successful then the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1336
     * link-up status bit will be set and the flow control enable bits (RFCE
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1337
     * and TFCE) will be set according to their negotiated value.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1338
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1339
    DEBUGOUT("Auto-negotiation enabled\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1340
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1341
    ew32(TXCW, txcw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1342
    ew32(CTRL, ctrl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1343
    E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1344
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1345
    hw->txcw = txcw;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1346
    msleep(1);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1347
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1348
    /* If we have a signal (the cable is plugged in) then poll for a "Link-Up"
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1349
     * indication in the Device Status Register.  Time-out if a link isn't
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1350
     * seen in 500 milliseconds seconds (Auto-negotiation should complete in
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1351
     * less than 500 milliseconds even if the other end is doing it in SW).
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1352
     * For internal serdes, we just assume a signal is present, then poll.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1353
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1354
    if (hw->media_type == e1000_media_type_internal_serdes ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1355
       (er32(CTRL) & E1000_CTRL_SWDPIN1) == signal) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1356
        DEBUGOUT("Looking for Link\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1357
        for (i = 0; i < (LINK_UP_TIMEOUT / 10); i++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1358
            msleep(10);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1359
            status = er32(STATUS);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1360
            if (status & E1000_STATUS_LU) break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1361
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1362
        if (i == (LINK_UP_TIMEOUT / 10)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1363
            DEBUGOUT("Never got a valid link from auto-neg!!!\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1364
            hw->autoneg_failed = 1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1365
            /* AutoNeg failed to achieve a link, so we'll call
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1366
             * e1000_check_for_link. This routine will force the link up if
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1367
             * we detect a signal. This will allow us to communicate with
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1368
             * non-autonegotiating link partners.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1369
             */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1370
            ret_val = e1000_check_for_link(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1371
            if (ret_val) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1372
                DEBUGOUT("Error while checking for link\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1373
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1374
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1375
            hw->autoneg_failed = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1376
        } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1377
            hw->autoneg_failed = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1378
            DEBUGOUT("Valid Link Found\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1379
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1380
    } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1381
        DEBUGOUT("No Signal Detected\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1382
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1383
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1384
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1385
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1386
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1387
* Make sure we have a valid PHY and change PHY mode before link setup.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1388
*
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1389
* hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1390
******************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1391
static s32 e1000_copper_link_preconfig(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1392
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1393
    u32 ctrl;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1394
    s32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1395
    u16 phy_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1396
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1397
    DEBUGFUNC("e1000_copper_link_preconfig");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1398
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1399
    ctrl = er32(CTRL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1400
    /* With 82543, we need to force speed and duplex on the MAC equal to what
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1401
     * the PHY speed and duplex configuration is. In addition, we need to
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1402
     * perform a hardware reset on the PHY to take it out of reset.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1403
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1404
    if (hw->mac_type > e1000_82543) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1405
        ctrl |= E1000_CTRL_SLU;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1406
        ctrl &= ~(E1000_CTRL_FRCSPD | E1000_CTRL_FRCDPX);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1407
        ew32(CTRL, ctrl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1408
    } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1409
        ctrl |= (E1000_CTRL_FRCSPD | E1000_CTRL_FRCDPX | E1000_CTRL_SLU);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1410
        ew32(CTRL, ctrl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1411
        ret_val = e1000_phy_hw_reset(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1412
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1413
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1414
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1415
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1416
    /* Make sure we have a valid PHY */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1417
    ret_val = e1000_detect_gig_phy(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1418
    if (ret_val) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1419
        DEBUGOUT("Error, did not detect valid phy.\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1420
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1421
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1422
    DEBUGOUT1("Phy ID = %x \n", hw->phy_id);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1423
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1424
    /* Set PHY to class A mode (if necessary) */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1425
    ret_val = e1000_set_phy_mode(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1426
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1427
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1428
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1429
    if ((hw->mac_type == e1000_82545_rev_3) ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1430
       (hw->mac_type == e1000_82546_rev_3)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1431
        ret_val = e1000_read_phy_reg(hw, M88E1000_PHY_SPEC_CTRL, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1432
        phy_data |= 0x00000008;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1433
        ret_val = e1000_write_phy_reg(hw, M88E1000_PHY_SPEC_CTRL, phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1434
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1435
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1436
    if (hw->mac_type <= e1000_82543 ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1437
        hw->mac_type == e1000_82541 || hw->mac_type == e1000_82547 ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1438
        hw->mac_type == e1000_82541_rev_2 || hw->mac_type == e1000_82547_rev_2)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1439
        hw->phy_reset_disable = false;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1440
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1441
   return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1442
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1443
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1444
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1445
/********************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1446
* Copper link setup for e1000_phy_igp series.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1447
*
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1448
* hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1449
*********************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1450
static s32 e1000_copper_link_igp_setup(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1451
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1452
    u32 led_ctrl;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1453
    s32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1454
    u16 phy_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1455
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1456
    DEBUGFUNC("e1000_copper_link_igp_setup");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1457
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1458
    if (hw->phy_reset_disable)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1459
        return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1460
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1461
    ret_val = e1000_phy_reset(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1462
    if (ret_val) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1463
        DEBUGOUT("Error Resetting the PHY\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1464
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1465
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1466
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1467
    /* Wait 15ms for MAC to configure PHY from eeprom settings */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1468
    msleep(15);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1469
    if (hw->mac_type != e1000_ich8lan) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1470
    /* Configure activity LED after PHY reset */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1471
    led_ctrl = er32(LEDCTL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1472
    led_ctrl &= IGP_ACTIVITY_LED_MASK;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1473
    led_ctrl |= (IGP_ACTIVITY_LED_ENABLE | IGP_LED3_MODE);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1474
    ew32(LEDCTL, led_ctrl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1475
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1476
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1477
    /* The NVM settings will configure LPLU in D3 for IGP2 and IGP3 PHYs */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1478
    if (hw->phy_type == e1000_phy_igp) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1479
        /* disable lplu d3 during driver init */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1480
        ret_val = e1000_set_d3_lplu_state(hw, false);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1481
        if (ret_val) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1482
            DEBUGOUT("Error Disabling LPLU D3\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1483
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1484
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1485
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1486
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1487
    /* disable lplu d0 during driver init */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1488
    ret_val = e1000_set_d0_lplu_state(hw, false);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1489
    if (ret_val) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1490
        DEBUGOUT("Error Disabling LPLU D0\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1491
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1492
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1493
    /* Configure mdi-mdix settings */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1494
    ret_val = e1000_read_phy_reg(hw, IGP01E1000_PHY_PORT_CTRL, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1495
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1496
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1497
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1498
    if ((hw->mac_type == e1000_82541) || (hw->mac_type == e1000_82547)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1499
        hw->dsp_config_state = e1000_dsp_config_disabled;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1500
        /* Force MDI for earlier revs of the IGP PHY */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1501
        phy_data &= ~(IGP01E1000_PSCR_AUTO_MDIX | IGP01E1000_PSCR_FORCE_MDI_MDIX);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1502
        hw->mdix = 1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1503
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1504
    } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1505
        hw->dsp_config_state = e1000_dsp_config_enabled;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1506
        phy_data &= ~IGP01E1000_PSCR_AUTO_MDIX;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1507
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1508
        switch (hw->mdix) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1509
        case 1:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1510
            phy_data &= ~IGP01E1000_PSCR_FORCE_MDI_MDIX;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1511
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1512
        case 2:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1513
            phy_data |= IGP01E1000_PSCR_FORCE_MDI_MDIX;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1514
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1515
        case 0:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1516
        default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1517
            phy_data |= IGP01E1000_PSCR_AUTO_MDIX;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1518
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1519
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1520
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1521
    ret_val = e1000_write_phy_reg(hw, IGP01E1000_PHY_PORT_CTRL, phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1522
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1523
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1524
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1525
    /* set auto-master slave resolution settings */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1526
    if (hw->autoneg) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1527
        e1000_ms_type phy_ms_setting = hw->master_slave;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1528
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1529
        if (hw->ffe_config_state == e1000_ffe_config_active)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1530
            hw->ffe_config_state = e1000_ffe_config_enabled;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1531
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1532
        if (hw->dsp_config_state == e1000_dsp_config_activated)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1533
            hw->dsp_config_state = e1000_dsp_config_enabled;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1534
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1535
        /* when autonegotiation advertisment is only 1000Mbps then we
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1536
          * should disable SmartSpeed and enable Auto MasterSlave
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1537
          * resolution as hardware default. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1538
        if (hw->autoneg_advertised == ADVERTISE_1000_FULL) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1539
            /* Disable SmartSpeed */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1540
            ret_val = e1000_read_phy_reg(hw, IGP01E1000_PHY_PORT_CONFIG,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1541
                                         &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1542
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1543
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1544
            phy_data &= ~IGP01E1000_PSCFR_SMART_SPEED;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1545
            ret_val = e1000_write_phy_reg(hw, IGP01E1000_PHY_PORT_CONFIG,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1546
                                          phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1547
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1548
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1549
            /* Set auto Master/Slave resolution process */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1550
            ret_val = e1000_read_phy_reg(hw, PHY_1000T_CTRL, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1551
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1552
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1553
            phy_data &= ~CR_1000T_MS_ENABLE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1554
            ret_val = e1000_write_phy_reg(hw, PHY_1000T_CTRL, phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1555
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1556
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1557
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1558
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1559
        ret_val = e1000_read_phy_reg(hw, PHY_1000T_CTRL, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1560
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1561
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1562
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1563
        /* load defaults for future use */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1564
        hw->original_master_slave = (phy_data & CR_1000T_MS_ENABLE) ?
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1565
                                        ((phy_data & CR_1000T_MS_VALUE) ?
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1566
                                         e1000_ms_force_master :
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1567
                                         e1000_ms_force_slave) :
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1568
                                         e1000_ms_auto;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1569
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1570
        switch (phy_ms_setting) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1571
        case e1000_ms_force_master:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1572
            phy_data |= (CR_1000T_MS_ENABLE | CR_1000T_MS_VALUE);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1573
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1574
        case e1000_ms_force_slave:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1575
            phy_data |= CR_1000T_MS_ENABLE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1576
            phy_data &= ~(CR_1000T_MS_VALUE);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1577
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1578
        case e1000_ms_auto:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1579
            phy_data &= ~CR_1000T_MS_ENABLE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1580
            default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1581
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1582
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1583
        ret_val = e1000_write_phy_reg(hw, PHY_1000T_CTRL, phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1584
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1585
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1586
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1587
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1588
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1589
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1590
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1591
/********************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1592
* Copper link setup for e1000_phy_gg82563 series.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1593
*
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1594
* hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1595
*********************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1596
static s32 e1000_copper_link_ggp_setup(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1597
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1598
    s32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1599
    u16 phy_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1600
    u32 reg_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1601
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1602
    DEBUGFUNC("e1000_copper_link_ggp_setup");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1603
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1604
    if (!hw->phy_reset_disable) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1605
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1606
        /* Enable CRS on TX for half-duplex operation. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1607
        ret_val = e1000_read_phy_reg(hw, GG82563_PHY_MAC_SPEC_CTRL,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1608
                                     &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1609
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1610
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1611
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1612
        phy_data |= GG82563_MSCR_ASSERT_CRS_ON_TX;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1613
        /* Use 25MHz for both link down and 1000BASE-T for Tx clock */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1614
        phy_data |= GG82563_MSCR_TX_CLK_1000MBPS_25MHZ;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1615
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1616
        ret_val = e1000_write_phy_reg(hw, GG82563_PHY_MAC_SPEC_CTRL,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1617
                                      phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1618
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1619
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1620
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1621
        /* Options:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1622
         *   MDI/MDI-X = 0 (default)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1623
         *   0 - Auto for all speeds
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1624
         *   1 - MDI mode
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1625
         *   2 - MDI-X mode
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1626
         *   3 - Auto for 1000Base-T only (MDI-X for 10/100Base-T modes)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1627
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1628
        ret_val = e1000_read_phy_reg(hw, GG82563_PHY_SPEC_CTRL, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1629
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1630
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1631
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1632
        phy_data &= ~GG82563_PSCR_CROSSOVER_MODE_MASK;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1633
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1634
        switch (hw->mdix) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1635
        case 1:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1636
            phy_data |= GG82563_PSCR_CROSSOVER_MODE_MDI;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1637
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1638
        case 2:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1639
            phy_data |= GG82563_PSCR_CROSSOVER_MODE_MDIX;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1640
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1641
        case 0:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1642
        default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1643
            phy_data |= GG82563_PSCR_CROSSOVER_MODE_AUTO;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1644
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1645
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1646
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1647
        /* Options:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1648
         *   disable_polarity_correction = 0 (default)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1649
         *       Automatic Correction for Reversed Cable Polarity
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1650
         *   0 - Disabled
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1651
         *   1 - Enabled
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1652
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1653
        phy_data &= ~GG82563_PSCR_POLARITY_REVERSAL_DISABLE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1654
        if (hw->disable_polarity_correction == 1)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1655
            phy_data |= GG82563_PSCR_POLARITY_REVERSAL_DISABLE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1656
        ret_val = e1000_write_phy_reg(hw, GG82563_PHY_SPEC_CTRL, phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1657
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1658
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1659
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1660
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1661
        /* SW Reset the PHY so all changes take effect */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1662
        ret_val = e1000_phy_reset(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1663
        if (ret_val) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1664
            DEBUGOUT("Error Resetting the PHY\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1665
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1666
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1667
    } /* phy_reset_disable */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1668
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1669
    if (hw->mac_type == e1000_80003es2lan) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1670
        /* Bypass RX and TX FIFO's */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1671
        ret_val = e1000_write_kmrn_reg(hw, E1000_KUMCTRLSTA_OFFSET_FIFO_CTRL,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1672
                                       E1000_KUMCTRLSTA_FIFO_CTRL_RX_BYPASS |
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1673
                                       E1000_KUMCTRLSTA_FIFO_CTRL_TX_BYPASS);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1674
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1675
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1676
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1677
        ret_val = e1000_read_phy_reg(hw, GG82563_PHY_SPEC_CTRL_2, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1678
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1679
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1680
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1681
        phy_data &= ~GG82563_PSCR2_REVERSE_AUTO_NEG;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1682
        ret_val = e1000_write_phy_reg(hw, GG82563_PHY_SPEC_CTRL_2, phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1683
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1684
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1685
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1686
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1687
        reg_data = er32(CTRL_EXT);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1688
        reg_data &= ~(E1000_CTRL_EXT_LINK_MODE_MASK);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1689
        ew32(CTRL_EXT, reg_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1690
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1691
        ret_val = e1000_read_phy_reg(hw, GG82563_PHY_PWR_MGMT_CTRL,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1692
                                          &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1693
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1694
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1695
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1696
        /* Do not init these registers when the HW is in IAMT mode, since the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1697
         * firmware will have already initialized them.  We only initialize
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1698
         * them if the HW is not in IAMT mode.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1699
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1700
        if (!e1000_check_mng_mode(hw)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1701
            /* Enable Electrical Idle on the PHY */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1702
            phy_data |= GG82563_PMCR_ENABLE_ELECTRICAL_IDLE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1703
            ret_val = e1000_write_phy_reg(hw, GG82563_PHY_PWR_MGMT_CTRL,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1704
                                          phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1705
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1706
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1707
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1708
            ret_val = e1000_read_phy_reg(hw, GG82563_PHY_KMRN_MODE_CTRL,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1709
                                         &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1710
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1711
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1712
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1713
            phy_data &= ~GG82563_KMCR_PASS_FALSE_CARRIER;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1714
            ret_val = e1000_write_phy_reg(hw, GG82563_PHY_KMRN_MODE_CTRL,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1715
                                          phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1716
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1717
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1718
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1719
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1720
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1721
        /* Workaround: Disable padding in Kumeran interface in the MAC
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1722
         * and in the PHY to avoid CRC errors.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1723
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1724
        ret_val = e1000_read_phy_reg(hw, GG82563_PHY_INBAND_CTRL,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1725
                                     &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1726
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1727
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1728
        phy_data |= GG82563_ICR_DIS_PADDING;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1729
        ret_val = e1000_write_phy_reg(hw, GG82563_PHY_INBAND_CTRL,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1730
                                      phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1731
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1732
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1733
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1734
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1735
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1736
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1737
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1738
/********************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1739
* Copper link setup for e1000_phy_m88 series.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1740
*
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1741
* hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1742
*********************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1743
static s32 e1000_copper_link_mgp_setup(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1744
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1745
    s32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1746
    u16 phy_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1747
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1748
    DEBUGFUNC("e1000_copper_link_mgp_setup");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1749
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1750
    if (hw->phy_reset_disable)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1751
        return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1752
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1753
    /* Enable CRS on TX. This must be set for half-duplex operation. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1754
    ret_val = e1000_read_phy_reg(hw, M88E1000_PHY_SPEC_CTRL, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1755
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1756
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1757
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1758
    phy_data |= M88E1000_PSCR_ASSERT_CRS_ON_TX;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1759
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1760
    /* Options:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1761
     *   MDI/MDI-X = 0 (default)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1762
     *   0 - Auto for all speeds
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1763
     *   1 - MDI mode
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1764
     *   2 - MDI-X mode
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1765
     *   3 - Auto for 1000Base-T only (MDI-X for 10/100Base-T modes)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1766
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1767
    phy_data &= ~M88E1000_PSCR_AUTO_X_MODE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1768
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1769
    switch (hw->mdix) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1770
    case 1:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1771
        phy_data |= M88E1000_PSCR_MDI_MANUAL_MODE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1772
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1773
    case 2:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1774
        phy_data |= M88E1000_PSCR_MDIX_MANUAL_MODE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1775
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1776
    case 3:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1777
        phy_data |= M88E1000_PSCR_AUTO_X_1000T;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1778
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1779
    case 0:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1780
    default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1781
        phy_data |= M88E1000_PSCR_AUTO_X_MODE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1782
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1783
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1784
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1785
    /* Options:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1786
     *   disable_polarity_correction = 0 (default)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1787
     *       Automatic Correction for Reversed Cable Polarity
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1788
     *   0 - Disabled
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1789
     *   1 - Enabled
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1790
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1791
    phy_data &= ~M88E1000_PSCR_POLARITY_REVERSAL;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1792
    if (hw->disable_polarity_correction == 1)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1793
        phy_data |= M88E1000_PSCR_POLARITY_REVERSAL;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1794
    ret_val = e1000_write_phy_reg(hw, M88E1000_PHY_SPEC_CTRL, phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1795
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1796
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1797
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1798
    if (hw->phy_revision < M88E1011_I_REV_4) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1799
        /* Force TX_CLK in the Extended PHY Specific Control Register
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1800
         * to 25MHz clock.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1801
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1802
        ret_val = e1000_read_phy_reg(hw, M88E1000_EXT_PHY_SPEC_CTRL, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1803
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1804
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1805
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1806
        phy_data |= M88E1000_EPSCR_TX_CLK_25;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1807
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1808
        if ((hw->phy_revision == E1000_REVISION_2) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1809
            (hw->phy_id == M88E1111_I_PHY_ID)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1810
            /* Vidalia Phy, set the downshift counter to 5x */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1811
            phy_data &= ~(M88EC018_EPSCR_DOWNSHIFT_COUNTER_MASK);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1812
            phy_data |= M88EC018_EPSCR_DOWNSHIFT_COUNTER_5X;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1813
            ret_val = e1000_write_phy_reg(hw,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1814
                                        M88E1000_EXT_PHY_SPEC_CTRL, phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1815
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1816
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1817
        } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1818
            /* Configure Master and Slave downshift values */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1819
            phy_data &= ~(M88E1000_EPSCR_MASTER_DOWNSHIFT_MASK |
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1820
                              M88E1000_EPSCR_SLAVE_DOWNSHIFT_MASK);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1821
            phy_data |= (M88E1000_EPSCR_MASTER_DOWNSHIFT_1X |
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1822
                             M88E1000_EPSCR_SLAVE_DOWNSHIFT_1X);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1823
            ret_val = e1000_write_phy_reg(hw,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1824
                                        M88E1000_EXT_PHY_SPEC_CTRL, phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1825
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1826
               return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1827
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1828
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1829
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1830
    /* SW Reset the PHY so all changes take effect */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1831
    ret_val = e1000_phy_reset(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1832
    if (ret_val) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1833
        DEBUGOUT("Error Resetting the PHY\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1834
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1835
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1836
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1837
   return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1838
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1839
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1840
/********************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1841
* Setup auto-negotiation and flow control advertisements,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1842
* and then perform auto-negotiation.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1843
*
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1844
* hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1845
*********************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1846
static s32 e1000_copper_link_autoneg(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1847
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1848
    s32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1849
    u16 phy_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1850
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1851
    DEBUGFUNC("e1000_copper_link_autoneg");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1852
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1853
    /* Perform some bounds checking on the hw->autoneg_advertised
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1854
     * parameter.  If this variable is zero, then set it to the default.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1855
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1856
    hw->autoneg_advertised &= AUTONEG_ADVERTISE_SPEED_DEFAULT;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1857
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1858
    /* If autoneg_advertised is zero, we assume it was not defaulted
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1859
     * by the calling code so we set to advertise full capability.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1860
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1861
    if (hw->autoneg_advertised == 0)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1862
        hw->autoneg_advertised = AUTONEG_ADVERTISE_SPEED_DEFAULT;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1863
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1864
    /* IFE phy only supports 10/100 */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1865
    if (hw->phy_type == e1000_phy_ife)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1866
        hw->autoneg_advertised &= AUTONEG_ADVERTISE_10_100_ALL;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1867
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1868
    DEBUGOUT("Reconfiguring auto-neg advertisement params\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1869
    ret_val = e1000_phy_setup_autoneg(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1870
    if (ret_val) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1871
        DEBUGOUT("Error Setting up Auto-Negotiation\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1872
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1873
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1874
    DEBUGOUT("Restarting Auto-Neg\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1875
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1876
    /* Restart auto-negotiation by setting the Auto Neg Enable bit and
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1877
     * the Auto Neg Restart bit in the PHY control register.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1878
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1879
    ret_val = e1000_read_phy_reg(hw, PHY_CTRL, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1880
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1881
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1882
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1883
    phy_data |= (MII_CR_AUTO_NEG_EN | MII_CR_RESTART_AUTO_NEG);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1884
    ret_val = e1000_write_phy_reg(hw, PHY_CTRL, phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1885
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1886
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1887
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1888
    /* Does the user want to wait for Auto-Neg to complete here, or
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1889
     * check at a later time (for example, callback routine).
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1890
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1891
    if (hw->wait_autoneg_complete) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1892
        ret_val = e1000_wait_autoneg(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1893
        if (ret_val) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1894
            DEBUGOUT("Error while waiting for autoneg to complete\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1895
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1896
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1897
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1898
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1899
    hw->get_link_status = true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1900
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1901
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1902
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1903
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1904
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1905
* Config the MAC and the PHY after link is up.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1906
*   1) Set up the MAC to the current PHY speed/duplex
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1907
*      if we are on 82543.  If we
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1908
*      are on newer silicon, we only need to configure
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1909
*      collision distance in the Transmit Control Register.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1910
*   2) Set up flow control on the MAC to that established with
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1911
*      the link partner.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1912
*   3) Config DSP to improve Gigabit link quality for some PHY revisions.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1913
*
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1914
* hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1915
******************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1916
static s32 e1000_copper_link_postconfig(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1917
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1918
    s32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1919
    DEBUGFUNC("e1000_copper_link_postconfig");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1920
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1921
    if (hw->mac_type >= e1000_82544) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1922
        e1000_config_collision_dist(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1923
    } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1924
        ret_val = e1000_config_mac_to_phy(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1925
        if (ret_val) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1926
            DEBUGOUT("Error configuring MAC to PHY settings\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1927
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1928
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1929
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1930
    ret_val = e1000_config_fc_after_link_up(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1931
    if (ret_val) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1932
        DEBUGOUT("Error Configuring Flow Control\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1933
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1934
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1935
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1936
    /* Config DSP to improve Giga link quality */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1937
    if (hw->phy_type == e1000_phy_igp) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1938
        ret_val = e1000_config_dsp_after_link_change(hw, true);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1939
        if (ret_val) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1940
            DEBUGOUT("Error Configuring DSP after link up\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1941
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1942
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1943
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1944
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1945
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1946
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1947
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1948
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1949
* Detects which PHY is present and setup the speed and duplex
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1950
*
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1951
* hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1952
******************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1953
static s32 e1000_setup_copper_link(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1954
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1955
    s32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1956
    u16 i;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1957
    u16 phy_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1958
    u16 reg_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1959
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1960
    DEBUGFUNC("e1000_setup_copper_link");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1961
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1962
    switch (hw->mac_type) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1963
    case e1000_80003es2lan:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1964
    case e1000_ich8lan:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1965
        /* Set the mac to wait the maximum time between each
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1966
         * iteration and increase the max iterations when
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1967
         * polling the phy; this fixes erroneous timeouts at 10Mbps. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1968
        ret_val = e1000_write_kmrn_reg(hw, GG82563_REG(0x34, 4), 0xFFFF);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1969
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1970
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1971
        ret_val = e1000_read_kmrn_reg(hw, GG82563_REG(0x34, 9), &reg_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1972
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1973
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1974
        reg_data |= 0x3F;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1975
        ret_val = e1000_write_kmrn_reg(hw, GG82563_REG(0x34, 9), reg_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1976
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1977
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1978
    default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1979
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1980
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1981
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1982
    /* Check if it is a valid PHY and set PHY mode if necessary. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1983
    ret_val = e1000_copper_link_preconfig(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1984
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1985
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1986
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1987
    switch (hw->mac_type) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1988
    case e1000_80003es2lan:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1989
        /* Kumeran registers are written-only */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1990
        reg_data = E1000_KUMCTRLSTA_INB_CTRL_LINK_STATUS_TX_TIMEOUT_DEFAULT;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1991
        reg_data |= E1000_KUMCTRLSTA_INB_CTRL_DIS_PADDING;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1992
        ret_val = e1000_write_kmrn_reg(hw, E1000_KUMCTRLSTA_OFFSET_INB_CTRL,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1993
                                       reg_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1994
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1995
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1996
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1997
    default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1998
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  1999
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2000
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2001
    if (hw->phy_type == e1000_phy_igp ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2002
        hw->phy_type == e1000_phy_igp_3 ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2003
        hw->phy_type == e1000_phy_igp_2) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2004
        ret_val = e1000_copper_link_igp_setup(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2005
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2006
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2007
    } else if (hw->phy_type == e1000_phy_m88) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2008
        ret_val = e1000_copper_link_mgp_setup(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2009
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2010
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2011
    } else if (hw->phy_type == e1000_phy_gg82563) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2012
        ret_val = e1000_copper_link_ggp_setup(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2013
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2014
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2015
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2016
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2017
    if (hw->autoneg) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2018
        /* Setup autoneg and flow control advertisement
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2019
          * and perform autonegotiation */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2020
        ret_val = e1000_copper_link_autoneg(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2021
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2022
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2023
    } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2024
        /* PHY will be set to 10H, 10F, 100H,or 100F
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2025
          * depending on value from forced_speed_duplex. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2026
        DEBUGOUT("Forcing speed and duplex\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2027
        ret_val = e1000_phy_force_speed_duplex(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2028
        if (ret_val) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2029
            DEBUGOUT("Error Forcing Speed and Duplex\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2030
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2031
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2032
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2033
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2034
    /* Check link status. Wait up to 100 microseconds for link to become
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2035
     * valid.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2036
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2037
    for (i = 0; i < 10; i++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2038
        ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2039
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2040
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2041
        ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2042
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2043
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2044
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2045
        if (phy_data & MII_SR_LINK_STATUS) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2046
            /* Config the MAC and PHY after link is up */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2047
            ret_val = e1000_copper_link_postconfig(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2048
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2049
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2050
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2051
            DEBUGOUT("Valid link established!!!\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2052
            return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2053
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2054
        udelay(10);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2055
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2056
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2057
    DEBUGOUT("Unable to establish link!!!\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2058
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2059
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2060
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2061
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2062
* Configure the MAC-to-PHY interface for 10/100Mbps
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2063
*
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2064
* hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2065
******************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2066
static s32 e1000_configure_kmrn_for_10_100(struct e1000_hw *hw, u16 duplex)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2067
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2068
    s32 ret_val = E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2069
    u32 tipg;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2070
    u16 reg_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2071
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2072
    DEBUGFUNC("e1000_configure_kmrn_for_10_100");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2073
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2074
    reg_data = E1000_KUMCTRLSTA_HD_CTRL_10_100_DEFAULT;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2075
    ret_val = e1000_write_kmrn_reg(hw, E1000_KUMCTRLSTA_OFFSET_HD_CTRL,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2076
                                   reg_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2077
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2078
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2079
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2080
    /* Configure Transmit Inter-Packet Gap */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2081
    tipg = er32(TIPG);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2082
    tipg &= ~E1000_TIPG_IPGT_MASK;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2083
    tipg |= DEFAULT_80003ES2LAN_TIPG_IPGT_10_100;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2084
    ew32(TIPG, tipg);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2085
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2086
    ret_val = e1000_read_phy_reg(hw, GG82563_PHY_KMRN_MODE_CTRL, &reg_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2087
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2088
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2089
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2090
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2091
    if (duplex == HALF_DUPLEX)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2092
        reg_data |= GG82563_KMCR_PASS_FALSE_CARRIER;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2093
    else
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2094
        reg_data &= ~GG82563_KMCR_PASS_FALSE_CARRIER;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2095
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2096
    ret_val = e1000_write_phy_reg(hw, GG82563_PHY_KMRN_MODE_CTRL, reg_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2097
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2098
    return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2099
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2100
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2101
static s32 e1000_configure_kmrn_for_1000(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2102
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2103
    s32 ret_val = E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2104
    u16 reg_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2105
    u32 tipg;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2106
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2107
    DEBUGFUNC("e1000_configure_kmrn_for_1000");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2108
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2109
    reg_data = E1000_KUMCTRLSTA_HD_CTRL_1000_DEFAULT;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2110
    ret_val = e1000_write_kmrn_reg(hw, E1000_KUMCTRLSTA_OFFSET_HD_CTRL,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2111
                                   reg_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2112
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2113
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2114
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2115
    /* Configure Transmit Inter-Packet Gap */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2116
    tipg = er32(TIPG);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2117
    tipg &= ~E1000_TIPG_IPGT_MASK;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2118
    tipg |= DEFAULT_80003ES2LAN_TIPG_IPGT_1000;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2119
    ew32(TIPG, tipg);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2120
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2121
    ret_val = e1000_read_phy_reg(hw, GG82563_PHY_KMRN_MODE_CTRL, &reg_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2122
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2123
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2124
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2125
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2126
    reg_data &= ~GG82563_KMCR_PASS_FALSE_CARRIER;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2127
    ret_val = e1000_write_phy_reg(hw, GG82563_PHY_KMRN_MODE_CTRL, reg_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2128
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2129
    return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2130
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2131
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2132
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2133
* Configures PHY autoneg and flow control advertisement settings
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2134
*
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2135
* hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2136
******************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2137
s32 e1000_phy_setup_autoneg(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2138
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2139
    s32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2140
    u16 mii_autoneg_adv_reg;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2141
    u16 mii_1000t_ctrl_reg;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2142
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2143
    DEBUGFUNC("e1000_phy_setup_autoneg");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2144
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2145
    /* Read the MII Auto-Neg Advertisement Register (Address 4). */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2146
    ret_val = e1000_read_phy_reg(hw, PHY_AUTONEG_ADV, &mii_autoneg_adv_reg);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2147
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2148
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2149
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2150
    if (hw->phy_type != e1000_phy_ife) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2151
        /* Read the MII 1000Base-T Control Register (Address 9). */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2152
        ret_val = e1000_read_phy_reg(hw, PHY_1000T_CTRL, &mii_1000t_ctrl_reg);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2153
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2154
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2155
    } else
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2156
        mii_1000t_ctrl_reg=0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2157
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2158
    /* Need to parse both autoneg_advertised and fc and set up
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2159
     * the appropriate PHY registers.  First we will parse for
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2160
     * autoneg_advertised software override.  Since we can advertise
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2161
     * a plethora of combinations, we need to check each bit
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2162
     * individually.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2163
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2164
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2165
    /* First we clear all the 10/100 mb speed bits in the Auto-Neg
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2166
     * Advertisement Register (Address 4) and the 1000 mb speed bits in
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2167
     * the  1000Base-T Control Register (Address 9).
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2168
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2169
    mii_autoneg_adv_reg &= ~REG4_SPEED_MASK;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2170
    mii_1000t_ctrl_reg &= ~REG9_SPEED_MASK;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2171
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2172
    DEBUGOUT1("autoneg_advertised %x\n", hw->autoneg_advertised);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2173
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2174
    /* Do we want to advertise 10 Mb Half Duplex? */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2175
    if (hw->autoneg_advertised & ADVERTISE_10_HALF) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2176
        DEBUGOUT("Advertise 10mb Half duplex\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2177
        mii_autoneg_adv_reg |= NWAY_AR_10T_HD_CAPS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2178
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2179
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2180
    /* Do we want to advertise 10 Mb Full Duplex? */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2181
    if (hw->autoneg_advertised & ADVERTISE_10_FULL) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2182
        DEBUGOUT("Advertise 10mb Full duplex\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2183
        mii_autoneg_adv_reg |= NWAY_AR_10T_FD_CAPS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2184
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2185
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2186
    /* Do we want to advertise 100 Mb Half Duplex? */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2187
    if (hw->autoneg_advertised & ADVERTISE_100_HALF) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2188
        DEBUGOUT("Advertise 100mb Half duplex\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2189
        mii_autoneg_adv_reg |= NWAY_AR_100TX_HD_CAPS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2190
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2191
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2192
    /* Do we want to advertise 100 Mb Full Duplex? */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2193
    if (hw->autoneg_advertised & ADVERTISE_100_FULL) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2194
        DEBUGOUT("Advertise 100mb Full duplex\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2195
        mii_autoneg_adv_reg |= NWAY_AR_100TX_FD_CAPS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2196
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2197
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2198
    /* We do not allow the Phy to advertise 1000 Mb Half Duplex */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2199
    if (hw->autoneg_advertised & ADVERTISE_1000_HALF) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2200
        DEBUGOUT("Advertise 1000mb Half duplex requested, request denied!\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2201
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2202
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2203
    /* Do we want to advertise 1000 Mb Full Duplex? */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2204
    if (hw->autoneg_advertised & ADVERTISE_1000_FULL) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2205
        DEBUGOUT("Advertise 1000mb Full duplex\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2206
        mii_1000t_ctrl_reg |= CR_1000T_FD_CAPS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2207
        if (hw->phy_type == e1000_phy_ife) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2208
            DEBUGOUT("e1000_phy_ife is a 10/100 PHY. Gigabit speed is not supported.\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2209
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2210
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2211
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2212
    /* Check for a software override of the flow control settings, and
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2213
     * setup the PHY advertisement registers accordingly.  If
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2214
     * auto-negotiation is enabled, then software will have to set the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2215
     * "PAUSE" bits to the correct value in the Auto-Negotiation
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2216
     * Advertisement Register (PHY_AUTONEG_ADV) and re-start auto-negotiation.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2217
     *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2218
     * The possible values of the "fc" parameter are:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2219
     *      0:  Flow control is completely disabled
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2220
     *      1:  Rx flow control is enabled (we can receive pause frames
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2221
     *          but not send pause frames).
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2222
     *      2:  Tx flow control is enabled (we can send pause frames
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2223
     *          but we do not support receiving pause frames).
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2224
     *      3:  Both Rx and TX flow control (symmetric) are enabled.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2225
     *  other:  No software override.  The flow control configuration
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2226
     *          in the EEPROM is used.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2227
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2228
    switch (hw->fc) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2229
    case E1000_FC_NONE: /* 0 */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2230
        /* Flow control (RX & TX) is completely disabled by a
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2231
         * software over-ride.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2232
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2233
        mii_autoneg_adv_reg &= ~(NWAY_AR_ASM_DIR | NWAY_AR_PAUSE);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2234
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2235
    case E1000_FC_RX_PAUSE: /* 1 */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2236
        /* RX Flow control is enabled, and TX Flow control is
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2237
         * disabled, by a software over-ride.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2238
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2239
        /* Since there really isn't a way to advertise that we are
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2240
         * capable of RX Pause ONLY, we will advertise that we
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2241
         * support both symmetric and asymmetric RX PAUSE.  Later
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2242
         * (in e1000_config_fc_after_link_up) we will disable the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2243
         *hw's ability to send PAUSE frames.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2244
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2245
        mii_autoneg_adv_reg |= (NWAY_AR_ASM_DIR | NWAY_AR_PAUSE);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2246
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2247
    case E1000_FC_TX_PAUSE: /* 2 */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2248
        /* TX Flow control is enabled, and RX Flow control is
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2249
         * disabled, by a software over-ride.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2250
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2251
        mii_autoneg_adv_reg |= NWAY_AR_ASM_DIR;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2252
        mii_autoneg_adv_reg &= ~NWAY_AR_PAUSE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2253
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2254
    case E1000_FC_FULL: /* 3 */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2255
        /* Flow control (both RX and TX) is enabled by a software
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2256
         * over-ride.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2257
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2258
        mii_autoneg_adv_reg |= (NWAY_AR_ASM_DIR | NWAY_AR_PAUSE);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2259
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2260
    default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2261
        DEBUGOUT("Flow control param set incorrectly\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2262
        return -E1000_ERR_CONFIG;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2263
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2264
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2265
    ret_val = e1000_write_phy_reg(hw, PHY_AUTONEG_ADV, mii_autoneg_adv_reg);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2266
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2267
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2268
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2269
    DEBUGOUT1("Auto-Neg Advertising %x\n", mii_autoneg_adv_reg);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2270
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2271
    if (hw->phy_type != e1000_phy_ife) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2272
        ret_val = e1000_write_phy_reg(hw, PHY_1000T_CTRL, mii_1000t_ctrl_reg);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2273
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2274
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2275
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2276
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2277
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2278
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2279
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2280
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2281
* Force PHY speed and duplex settings to hw->forced_speed_duplex
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2282
*
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2283
* hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2284
******************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2285
static s32 e1000_phy_force_speed_duplex(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2286
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2287
    u32 ctrl;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2288
    s32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2289
    u16 mii_ctrl_reg;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2290
    u16 mii_status_reg;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2291
    u16 phy_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2292
    u16 i;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2293
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2294
    DEBUGFUNC("e1000_phy_force_speed_duplex");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2295
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2296
    /* Turn off Flow control if we are forcing speed and duplex. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2297
    hw->fc = E1000_FC_NONE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2298
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2299
    DEBUGOUT1("hw->fc = %d\n", hw->fc);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2300
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2301
    /* Read the Device Control Register. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2302
    ctrl = er32(CTRL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2303
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2304
    /* Set the bits to Force Speed and Duplex in the Device Ctrl Reg. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2305
    ctrl |= (E1000_CTRL_FRCSPD | E1000_CTRL_FRCDPX);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2306
    ctrl &= ~(DEVICE_SPEED_MASK);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2307
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2308
    /* Clear the Auto Speed Detect Enable bit. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2309
    ctrl &= ~E1000_CTRL_ASDE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2310
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2311
    /* Read the MII Control Register. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2312
    ret_val = e1000_read_phy_reg(hw, PHY_CTRL, &mii_ctrl_reg);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2313
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2314
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2315
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2316
    /* We need to disable autoneg in order to force link and duplex. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2317
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2318
    mii_ctrl_reg &= ~MII_CR_AUTO_NEG_EN;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2319
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2320
    /* Are we forcing Full or Half Duplex? */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2321
    if (hw->forced_speed_duplex == e1000_100_full ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2322
        hw->forced_speed_duplex == e1000_10_full) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2323
        /* We want to force full duplex so we SET the full duplex bits in the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2324
         * Device and MII Control Registers.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2325
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2326
        ctrl |= E1000_CTRL_FD;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2327
        mii_ctrl_reg |= MII_CR_FULL_DUPLEX;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2328
        DEBUGOUT("Full Duplex\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2329
    } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2330
        /* We want to force half duplex so we CLEAR the full duplex bits in
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2331
         * the Device and MII Control Registers.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2332
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2333
        ctrl &= ~E1000_CTRL_FD;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2334
        mii_ctrl_reg &= ~MII_CR_FULL_DUPLEX;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2335
        DEBUGOUT("Half Duplex\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2336
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2337
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2338
    /* Are we forcing 100Mbps??? */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2339
    if (hw->forced_speed_duplex == e1000_100_full ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2340
       hw->forced_speed_duplex == e1000_100_half) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2341
        /* Set the 100Mb bit and turn off the 1000Mb and 10Mb bits. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2342
        ctrl |= E1000_CTRL_SPD_100;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2343
        mii_ctrl_reg |= MII_CR_SPEED_100;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2344
        mii_ctrl_reg &= ~(MII_CR_SPEED_1000 | MII_CR_SPEED_10);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2345
        DEBUGOUT("Forcing 100mb ");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2346
    } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2347
        /* Set the 10Mb bit and turn off the 1000Mb and 100Mb bits. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2348
        ctrl &= ~(E1000_CTRL_SPD_1000 | E1000_CTRL_SPD_100);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2349
        mii_ctrl_reg |= MII_CR_SPEED_10;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2350
        mii_ctrl_reg &= ~(MII_CR_SPEED_1000 | MII_CR_SPEED_100);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2351
        DEBUGOUT("Forcing 10mb ");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2352
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2353
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2354
    e1000_config_collision_dist(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2355
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2356
    /* Write the configured values back to the Device Control Reg. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2357
    ew32(CTRL, ctrl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2358
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2359
    if ((hw->phy_type == e1000_phy_m88) ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2360
        (hw->phy_type == e1000_phy_gg82563)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2361
        ret_val = e1000_read_phy_reg(hw, M88E1000_PHY_SPEC_CTRL, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2362
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2363
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2364
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2365
        /* Clear Auto-Crossover to force MDI manually. M88E1000 requires MDI
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2366
         * forced whenever speed are duplex are forced.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2367
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2368
        phy_data &= ~M88E1000_PSCR_AUTO_X_MODE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2369
        ret_val = e1000_write_phy_reg(hw, M88E1000_PHY_SPEC_CTRL, phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2370
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2371
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2372
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2373
        DEBUGOUT1("M88E1000 PSCR: %x \n", phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2374
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2375
        /* Need to reset the PHY or these changes will be ignored */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2376
        mii_ctrl_reg |= MII_CR_RESET;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2377
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2378
    /* Disable MDI-X support for 10/100 */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2379
    } else if (hw->phy_type == e1000_phy_ife) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2380
        ret_val = e1000_read_phy_reg(hw, IFE_PHY_MDIX_CONTROL, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2381
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2382
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2383
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2384
        phy_data &= ~IFE_PMC_AUTO_MDIX;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2385
        phy_data &= ~IFE_PMC_FORCE_MDIX;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2386
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2387
        ret_val = e1000_write_phy_reg(hw, IFE_PHY_MDIX_CONTROL, phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2388
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2389
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2390
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2391
    } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2392
        /* Clear Auto-Crossover to force MDI manually.  IGP requires MDI
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2393
         * forced whenever speed or duplex are forced.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2394
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2395
        ret_val = e1000_read_phy_reg(hw, IGP01E1000_PHY_PORT_CTRL, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2396
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2397
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2398
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2399
        phy_data &= ~IGP01E1000_PSCR_AUTO_MDIX;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2400
        phy_data &= ~IGP01E1000_PSCR_FORCE_MDI_MDIX;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2401
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2402
        ret_val = e1000_write_phy_reg(hw, IGP01E1000_PHY_PORT_CTRL, phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2403
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2404
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2405
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2406
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2407
    /* Write back the modified PHY MII control register. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2408
    ret_val = e1000_write_phy_reg(hw, PHY_CTRL, mii_ctrl_reg);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2409
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2410
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2411
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2412
    udelay(1);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2413
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2414
    /* The wait_autoneg_complete flag may be a little misleading here.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2415
     * Since we are forcing speed and duplex, Auto-Neg is not enabled.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2416
     * But we do want to delay for a period while forcing only so we
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2417
     * don't generate false No Link messages.  So we will wait here
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2418
     * only if the user has set wait_autoneg_complete to 1, which is
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2419
     * the default.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2420
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2421
    if (hw->wait_autoneg_complete) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2422
        /* We will wait for autoneg to complete. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2423
        DEBUGOUT("Waiting for forced speed/duplex link.\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2424
        mii_status_reg = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2425
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2426
        /* We will wait for autoneg to complete or 4.5 seconds to expire. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2427
        for (i = PHY_FORCE_TIME; i > 0; i--) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2428
            /* Read the MII Status Register and wait for Auto-Neg Complete bit
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2429
             * to be set.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2430
             */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2431
            ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &mii_status_reg);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2432
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2433
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2434
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2435
            ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &mii_status_reg);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2436
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2437
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2438
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2439
            if (mii_status_reg & MII_SR_LINK_STATUS) break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2440
            msleep(100);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2441
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2442
        if ((i == 0) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2443
           ((hw->phy_type == e1000_phy_m88) ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2444
            (hw->phy_type == e1000_phy_gg82563))) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2445
            /* We didn't get link.  Reset the DSP and wait again for link. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2446
            ret_val = e1000_phy_reset_dsp(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2447
            if (ret_val) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2448
                DEBUGOUT("Error Resetting PHY DSP\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2449
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2450
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2451
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2452
        /* This loop will early-out if the link condition has been met.  */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2453
        for (i = PHY_FORCE_TIME; i > 0; i--) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2454
            if (mii_status_reg & MII_SR_LINK_STATUS) break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2455
            msleep(100);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2456
            /* Read the MII Status Register and wait for Auto-Neg Complete bit
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2457
             * to be set.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2458
             */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2459
            ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &mii_status_reg);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2460
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2461
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2462
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2463
            ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &mii_status_reg);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2464
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2465
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2466
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2467
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2468
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2469
    if (hw->phy_type == e1000_phy_m88) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2470
        /* Because we reset the PHY above, we need to re-force TX_CLK in the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2471
         * Extended PHY Specific Control Register to 25MHz clock.  This value
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2472
         * defaults back to a 2.5MHz clock when the PHY is reset.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2473
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2474
        ret_val = e1000_read_phy_reg(hw, M88E1000_EXT_PHY_SPEC_CTRL, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2475
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2476
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2477
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2478
        phy_data |= M88E1000_EPSCR_TX_CLK_25;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2479
        ret_val = e1000_write_phy_reg(hw, M88E1000_EXT_PHY_SPEC_CTRL, phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2480
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2481
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2482
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2483
        /* In addition, because of the s/w reset above, we need to enable CRS on
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2484
         * TX.  This must be set for both full and half duplex operation.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2485
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2486
        ret_val = e1000_read_phy_reg(hw, M88E1000_PHY_SPEC_CTRL, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2487
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2488
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2489
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2490
        phy_data |= M88E1000_PSCR_ASSERT_CRS_ON_TX;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2491
        ret_val = e1000_write_phy_reg(hw, M88E1000_PHY_SPEC_CTRL, phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2492
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2493
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2494
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2495
        if ((hw->mac_type == e1000_82544 || hw->mac_type == e1000_82543) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2496
            (!hw->autoneg) && (hw->forced_speed_duplex == e1000_10_full ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2497
             hw->forced_speed_duplex == e1000_10_half)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2498
            ret_val = e1000_polarity_reversal_workaround(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2499
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2500
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2501
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2502
    } else if (hw->phy_type == e1000_phy_gg82563) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2503
        /* The TX_CLK of the Extended PHY Specific Control Register defaults
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2504
         * to 2.5MHz on a reset.  We need to re-force it back to 25MHz, if
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2505
         * we're not in a forced 10/duplex configuration. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2506
        ret_val = e1000_read_phy_reg(hw, GG82563_PHY_MAC_SPEC_CTRL, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2507
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2508
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2509
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2510
        phy_data &= ~GG82563_MSCR_TX_CLK_MASK;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2511
        if ((hw->forced_speed_duplex == e1000_10_full) ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2512
            (hw->forced_speed_duplex == e1000_10_half))
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2513
            phy_data |= GG82563_MSCR_TX_CLK_10MBPS_2_5MHZ;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2514
        else
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2515
            phy_data |= GG82563_MSCR_TX_CLK_100MBPS_25MHZ;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2516
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2517
        /* Also due to the reset, we need to enable CRS on Tx. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2518
        phy_data |= GG82563_MSCR_ASSERT_CRS_ON_TX;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2519
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2520
        ret_val = e1000_write_phy_reg(hw, GG82563_PHY_MAC_SPEC_CTRL, phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2521
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2522
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2523
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2524
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2525
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2526
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2527
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2528
* Sets the collision distance in the Transmit Control register
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2529
*
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2530
* hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2531
*
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2532
* Link should have been established previously. Reads the speed and duplex
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2533
* information from the Device Status register.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2534
******************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2535
void e1000_config_collision_dist(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2536
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2537
    u32 tctl, coll_dist;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2538
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2539
    DEBUGFUNC("e1000_config_collision_dist");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2540
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2541
    if (hw->mac_type < e1000_82543)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2542
        coll_dist = E1000_COLLISION_DISTANCE_82542;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2543
    else
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2544
        coll_dist = E1000_COLLISION_DISTANCE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2545
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2546
    tctl = er32(TCTL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2547
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2548
    tctl &= ~E1000_TCTL_COLD;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2549
    tctl |= coll_dist << E1000_COLD_SHIFT;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2550
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2551
    ew32(TCTL, tctl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2552
    E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2553
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2554
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2555
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2556
* Sets MAC speed and duplex settings to reflect the those in the PHY
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2557
*
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2558
* hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2559
* mii_reg - data to write to the MII control register
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2560
*
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2561
* The contents of the PHY register containing the needed information need to
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2562
* be passed in.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2563
******************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2564
static s32 e1000_config_mac_to_phy(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2565
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2566
    u32 ctrl;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2567
    s32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2568
    u16 phy_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2569
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2570
    DEBUGFUNC("e1000_config_mac_to_phy");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2571
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2572
    /* 82544 or newer MAC, Auto Speed Detection takes care of
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2573
    * MAC speed/duplex configuration.*/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2574
    if (hw->mac_type >= e1000_82544)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2575
        return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2576
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2577
    /* Read the Device Control Register and set the bits to Force Speed
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2578
     * and Duplex.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2579
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2580
    ctrl = er32(CTRL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2581
    ctrl |= (E1000_CTRL_FRCSPD | E1000_CTRL_FRCDPX);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2582
    ctrl &= ~(E1000_CTRL_SPD_SEL | E1000_CTRL_ILOS);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2583
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2584
    /* Set up duplex in the Device Control and Transmit Control
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2585
     * registers depending on negotiated values.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2586
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2587
    ret_val = e1000_read_phy_reg(hw, M88E1000_PHY_SPEC_STATUS, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2588
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2589
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2590
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2591
    if (phy_data & M88E1000_PSSR_DPLX)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2592
        ctrl |= E1000_CTRL_FD;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2593
    else
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2594
        ctrl &= ~E1000_CTRL_FD;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2595
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2596
    e1000_config_collision_dist(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2597
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2598
    /* Set up speed in the Device Control register depending on
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2599
     * negotiated values.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2600
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2601
    if ((phy_data & M88E1000_PSSR_SPEED) == M88E1000_PSSR_1000MBS)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2602
        ctrl |= E1000_CTRL_SPD_1000;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2603
    else if ((phy_data & M88E1000_PSSR_SPEED) == M88E1000_PSSR_100MBS)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2604
        ctrl |= E1000_CTRL_SPD_100;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2605
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2606
    /* Write the configured values back to the Device Control Reg. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2607
    ew32(CTRL, ctrl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2608
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2609
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2610
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2611
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2612
 * Forces the MAC's flow control settings.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2613
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2614
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2615
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2616
 * Sets the TFCE and RFCE bits in the device control register to reflect
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2617
 * the adapter settings. TFCE and RFCE need to be explicitly set by
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2618
 * software when a Copper PHY is used because autonegotiation is managed
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2619
 * by the PHY rather than the MAC. Software must also configure these
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2620
 * bits when link is forced on a fiber connection.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2621
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2622
s32 e1000_force_mac_fc(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2623
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2624
    u32 ctrl;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2625
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2626
    DEBUGFUNC("e1000_force_mac_fc");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2627
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2628
    /* Get the current configuration of the Device Control Register */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2629
    ctrl = er32(CTRL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2630
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2631
    /* Because we didn't get link via the internal auto-negotiation
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2632
     * mechanism (we either forced link or we got link via PHY
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2633
     * auto-neg), we have to manually enable/disable transmit an
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2634
     * receive flow control.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2635
     *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2636
     * The "Case" statement below enables/disable flow control
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2637
     * according to the "hw->fc" parameter.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2638
     *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2639
     * The possible values of the "fc" parameter are:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2640
     *      0:  Flow control is completely disabled
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2641
     *      1:  Rx flow control is enabled (we can receive pause
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2642
     *          frames but not send pause frames).
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2643
     *      2:  Tx flow control is enabled (we can send pause frames
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2644
     *          frames but we do not receive pause frames).
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2645
     *      3:  Both Rx and TX flow control (symmetric) is enabled.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2646
     *  other:  No other values should be possible at this point.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2647
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2648
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2649
    switch (hw->fc) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2650
    case E1000_FC_NONE:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2651
        ctrl &= (~(E1000_CTRL_TFCE | E1000_CTRL_RFCE));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2652
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2653
    case E1000_FC_RX_PAUSE:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2654
        ctrl &= (~E1000_CTRL_TFCE);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2655
        ctrl |= E1000_CTRL_RFCE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2656
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2657
    case E1000_FC_TX_PAUSE:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2658
        ctrl &= (~E1000_CTRL_RFCE);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2659
        ctrl |= E1000_CTRL_TFCE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2660
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2661
    case E1000_FC_FULL:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2662
        ctrl |= (E1000_CTRL_TFCE | E1000_CTRL_RFCE);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2663
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2664
    default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2665
        DEBUGOUT("Flow control param set incorrectly\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2666
        return -E1000_ERR_CONFIG;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2667
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2668
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2669
    /* Disable TX Flow Control for 82542 (rev 2.0) */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2670
    if (hw->mac_type == e1000_82542_rev2_0)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2671
        ctrl &= (~E1000_CTRL_TFCE);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2672
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2673
    ew32(CTRL, ctrl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2674
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2675
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2676
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2677
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2678
 * Configures flow control settings after link is established
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2679
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2680
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2681
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2682
 * Should be called immediately after a valid link has been established.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2683
 * Forces MAC flow control settings if link was forced. When in MII/GMII mode
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2684
 * and autonegotiation is enabled, the MAC flow control settings will be set
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2685
 * based on the flow control negotiated by the PHY. In TBI mode, the TFCE
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2686
 * and RFCE bits will be automaticaly set to the negotiated flow control mode.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2687
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2688
static s32 e1000_config_fc_after_link_up(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2689
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2690
    s32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2691
    u16 mii_status_reg;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2692
    u16 mii_nway_adv_reg;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2693
    u16 mii_nway_lp_ability_reg;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2694
    u16 speed;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2695
    u16 duplex;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2696
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2697
    DEBUGFUNC("e1000_config_fc_after_link_up");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2698
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2699
    /* Check for the case where we have fiber media and auto-neg failed
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2700
     * so we had to force link.  In this case, we need to force the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2701
     * configuration of the MAC to match the "fc" parameter.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2702
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2703
    if (((hw->media_type == e1000_media_type_fiber) && (hw->autoneg_failed)) ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2704
        ((hw->media_type == e1000_media_type_internal_serdes) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2705
         (hw->autoneg_failed)) ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2706
        ((hw->media_type == e1000_media_type_copper) && (!hw->autoneg))) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2707
        ret_val = e1000_force_mac_fc(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2708
        if (ret_val) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2709
            DEBUGOUT("Error forcing flow control settings\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2710
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2711
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2712
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2713
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2714
    /* Check for the case where we have copper media and auto-neg is
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2715
     * enabled.  In this case, we need to check and see if Auto-Neg
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2716
     * has completed, and if so, how the PHY and link partner has
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2717
     * flow control configured.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2718
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2719
    if ((hw->media_type == e1000_media_type_copper) && hw->autoneg) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2720
        /* Read the MII Status Register and check to see if AutoNeg
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2721
         * has completed.  We read this twice because this reg has
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2722
         * some "sticky" (latched) bits.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2723
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2724
        ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &mii_status_reg);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2725
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2726
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2727
        ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &mii_status_reg);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2728
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2729
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2730
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2731
        if (mii_status_reg & MII_SR_AUTONEG_COMPLETE) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2732
            /* The AutoNeg process has completed, so we now need to
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2733
             * read both the Auto Negotiation Advertisement Register
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2734
             * (Address 4) and the Auto_Negotiation Base Page Ability
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2735
             * Register (Address 5) to determine how flow control was
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2736
             * negotiated.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2737
             */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2738
            ret_val = e1000_read_phy_reg(hw, PHY_AUTONEG_ADV,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2739
                                         &mii_nway_adv_reg);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2740
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2741
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2742
            ret_val = e1000_read_phy_reg(hw, PHY_LP_ABILITY,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2743
                                         &mii_nway_lp_ability_reg);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2744
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2745
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2746
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2747
            /* Two bits in the Auto Negotiation Advertisement Register
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2748
             * (Address 4) and two bits in the Auto Negotiation Base
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2749
             * Page Ability Register (Address 5) determine flow control
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2750
             * for both the PHY and the link partner.  The following
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2751
             * table, taken out of the IEEE 802.3ab/D6.0 dated March 25,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2752
             * 1999, describes these PAUSE resolution bits and how flow
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2753
             * control is determined based upon these settings.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2754
             * NOTE:  DC = Don't Care
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2755
             *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2756
             *   LOCAL DEVICE  |   LINK PARTNER
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2757
             * PAUSE | ASM_DIR | PAUSE | ASM_DIR | NIC Resolution
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2758
             *-------|---------|-------|---------|--------------------
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2759
             *   0   |    0    |  DC   |   DC    | E1000_FC_NONE
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2760
             *   0   |    1    |   0   |   DC    | E1000_FC_NONE
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2761
             *   0   |    1    |   1   |    0    | E1000_FC_NONE
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2762
             *   0   |    1    |   1   |    1    | E1000_FC_TX_PAUSE
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2763
             *   1   |    0    |   0   |   DC    | E1000_FC_NONE
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2764
             *   1   |   DC    |   1   |   DC    | E1000_FC_FULL
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2765
             *   1   |    1    |   0   |    0    | E1000_FC_NONE
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2766
             *   1   |    1    |   0   |    1    | E1000_FC_RX_PAUSE
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2767
             *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2768
             */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2769
            /* Are both PAUSE bits set to 1?  If so, this implies
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2770
             * Symmetric Flow Control is enabled at both ends.  The
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2771
             * ASM_DIR bits are irrelevant per the spec.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2772
             *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2773
             * For Symmetric Flow Control:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2774
             *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2775
             *   LOCAL DEVICE  |   LINK PARTNER
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2776
             * PAUSE | ASM_DIR | PAUSE | ASM_DIR | Result
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2777
             *-------|---------|-------|---------|--------------------
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2778
             *   1   |   DC    |   1   |   DC    | E1000_FC_FULL
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2779
             *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2780
             */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2781
            if ((mii_nway_adv_reg & NWAY_AR_PAUSE) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2782
                (mii_nway_lp_ability_reg & NWAY_LPAR_PAUSE)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2783
                /* Now we need to check if the user selected RX ONLY
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2784
                 * of pause frames.  In this case, we had to advertise
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2785
                 * FULL flow control because we could not advertise RX
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2786
                 * ONLY. Hence, we must now check to see if we need to
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2787
                 * turn OFF  the TRANSMISSION of PAUSE frames.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2788
                 */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2789
                if (hw->original_fc == E1000_FC_FULL) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2790
                    hw->fc = E1000_FC_FULL;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2791
                    DEBUGOUT("Flow Control = FULL.\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2792
                } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2793
                    hw->fc = E1000_FC_RX_PAUSE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2794
                    DEBUGOUT("Flow Control = RX PAUSE frames only.\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2795
                }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2796
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2797
            /* For receiving PAUSE frames ONLY.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2798
             *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2799
             *   LOCAL DEVICE  |   LINK PARTNER
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2800
             * PAUSE | ASM_DIR | PAUSE | ASM_DIR | Result
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2801
             *-------|---------|-------|---------|--------------------
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2802
             *   0   |    1    |   1   |    1    | E1000_FC_TX_PAUSE
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2803
             *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2804
             */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2805
            else if (!(mii_nway_adv_reg & NWAY_AR_PAUSE) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2806
                     (mii_nway_adv_reg & NWAY_AR_ASM_DIR) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2807
                     (mii_nway_lp_ability_reg & NWAY_LPAR_PAUSE) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2808
                     (mii_nway_lp_ability_reg & NWAY_LPAR_ASM_DIR)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2809
                hw->fc = E1000_FC_TX_PAUSE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2810
                DEBUGOUT("Flow Control = TX PAUSE frames only.\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2811
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2812
            /* For transmitting PAUSE frames ONLY.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2813
             *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2814
             *   LOCAL DEVICE  |   LINK PARTNER
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2815
             * PAUSE | ASM_DIR | PAUSE | ASM_DIR | Result
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2816
             *-------|---------|-------|---------|--------------------
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2817
             *   1   |    1    |   0   |    1    | E1000_FC_RX_PAUSE
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2818
             *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2819
             */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2820
            else if ((mii_nway_adv_reg & NWAY_AR_PAUSE) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2821
                     (mii_nway_adv_reg & NWAY_AR_ASM_DIR) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2822
                     !(mii_nway_lp_ability_reg & NWAY_LPAR_PAUSE) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2823
                     (mii_nway_lp_ability_reg & NWAY_LPAR_ASM_DIR)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2824
                hw->fc = E1000_FC_RX_PAUSE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2825
                DEBUGOUT("Flow Control = RX PAUSE frames only.\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2826
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2827
            /* Per the IEEE spec, at this point flow control should be
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2828
             * disabled.  However, we want to consider that we could
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2829
             * be connected to a legacy switch that doesn't advertise
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2830
             * desired flow control, but can be forced on the link
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2831
             * partner.  So if we advertised no flow control, that is
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2832
             * what we will resolve to.  If we advertised some kind of
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2833
             * receive capability (Rx Pause Only or Full Flow Control)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2834
             * and the link partner advertised none, we will configure
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2835
             * ourselves to enable Rx Flow Control only.  We can do
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2836
             * this safely for two reasons:  If the link partner really
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2837
             * didn't want flow control enabled, and we enable Rx, no
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2838
             * harm done since we won't be receiving any PAUSE frames
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2839
             * anyway.  If the intent on the link partner was to have
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2840
             * flow control enabled, then by us enabling RX only, we
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2841
             * can at least receive pause frames and process them.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2842
             * This is a good idea because in most cases, since we are
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2843
             * predominantly a server NIC, more times than not we will
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2844
             * be asked to delay transmission of packets than asking
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2845
             * our link partner to pause transmission of frames.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2846
             */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2847
            else if ((hw->original_fc == E1000_FC_NONE ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2848
                      hw->original_fc == E1000_FC_TX_PAUSE) ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2849
                      hw->fc_strict_ieee) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2850
                hw->fc = E1000_FC_NONE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2851
                DEBUGOUT("Flow Control = NONE.\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2852
            } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2853
                hw->fc = E1000_FC_RX_PAUSE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2854
                DEBUGOUT("Flow Control = RX PAUSE frames only.\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2855
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2856
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2857
            /* Now we need to do one last check...  If we auto-
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2858
             * negotiated to HALF DUPLEX, flow control should not be
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2859
             * enabled per IEEE 802.3 spec.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2860
             */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2861
            ret_val = e1000_get_speed_and_duplex(hw, &speed, &duplex);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2862
            if (ret_val) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2863
                DEBUGOUT("Error getting link speed and duplex\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2864
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2865
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2866
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2867
            if (duplex == HALF_DUPLEX)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2868
                hw->fc = E1000_FC_NONE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2869
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2870
            /* Now we call a subroutine to actually force the MAC
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2871
             * controller to use the correct flow control settings.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2872
             */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2873
            ret_val = e1000_force_mac_fc(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2874
            if (ret_val) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2875
                DEBUGOUT("Error forcing flow control settings\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2876
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2877
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2878
        } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2879
            DEBUGOUT("Copper PHY and Auto Neg has not completed.\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2880
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2881
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2882
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2883
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2884
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2885
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2886
 * Checks to see if the link status of the hardware has changed.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2887
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2888
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2889
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2890
 * Called by any function that needs to check the link status of the adapter.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2891
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2892
s32 e1000_check_for_link(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2893
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2894
    u32 rxcw = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2895
    u32 ctrl;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2896
    u32 status;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2897
    u32 rctl;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2898
    u32 icr;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2899
    u32 signal = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2900
    s32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2901
    u16 phy_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2902
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2903
    DEBUGFUNC("e1000_check_for_link");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2904
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2905
    ctrl = er32(CTRL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2906
    status = er32(STATUS);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2907
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2908
    /* On adapters with a MAC newer than 82544, SW Defineable pin 1 will be
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2909
     * set when the optics detect a signal. On older adapters, it will be
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2910
     * cleared when there is a signal.  This applies to fiber media only.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2911
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2912
    if ((hw->media_type == e1000_media_type_fiber) ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2913
        (hw->media_type == e1000_media_type_internal_serdes)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2914
        rxcw = er32(RXCW);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2915
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2916
        if (hw->media_type == e1000_media_type_fiber) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2917
            signal = (hw->mac_type > e1000_82544) ? E1000_CTRL_SWDPIN1 : 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2918
            if (status & E1000_STATUS_LU)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2919
                hw->get_link_status = false;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2920
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2921
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2922
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2923
    /* If we have a copper PHY then we only want to go out to the PHY
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2924
     * registers to see if Auto-Neg has completed and/or if our link
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2925
     * status has changed.  The get_link_status flag will be set if we
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2926
     * receive a Link Status Change interrupt or we have Rx Sequence
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2927
     * Errors.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2928
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2929
    if ((hw->media_type == e1000_media_type_copper) && hw->get_link_status) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2930
        /* First we want to see if the MII Status Register reports
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2931
         * link.  If so, then we want to get the current speed/duplex
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2932
         * of the PHY.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2933
         * Read the register twice since the link bit is sticky.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2934
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2935
        ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2936
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2937
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2938
        ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2939
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2940
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2941
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2942
        if (phy_data & MII_SR_LINK_STATUS) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2943
            hw->get_link_status = false;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2944
            /* Check if there was DownShift, must be checked immediately after
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2945
             * link-up */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2946
            e1000_check_downshift(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2947
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2948
            /* If we are on 82544 or 82543 silicon and speed/duplex
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2949
             * are forced to 10H or 10F, then we will implement the polarity
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2950
             * reversal workaround.  We disable interrupts first, and upon
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2951
             * returning, place the devices interrupt state to its previous
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2952
             * value except for the link status change interrupt which will
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2953
             * happen due to the execution of this workaround.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2954
             */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2955
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2956
            if ((hw->mac_type == e1000_82544 || hw->mac_type == e1000_82543) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2957
                (!hw->autoneg) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2958
                (hw->forced_speed_duplex == e1000_10_full ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2959
                 hw->forced_speed_duplex == e1000_10_half)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2960
                ew32(IMC, 0xffffffff);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2961
                ret_val = e1000_polarity_reversal_workaround(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2962
                icr = er32(ICR);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2963
                ew32(ICS, (icr & ~E1000_ICS_LSC));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2964
                ew32(IMS, IMS_ENABLE_MASK);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2965
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2966
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2967
        } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2968
            /* No link detected */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2969
            e1000_config_dsp_after_link_change(hw, false);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2970
            return 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2971
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2972
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2973
        /* If we are forcing speed/duplex, then we simply return since
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2974
         * we have already determined whether we have link or not.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2975
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2976
        if (!hw->autoneg) return -E1000_ERR_CONFIG;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2977
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2978
        /* optimize the dsp settings for the igp phy */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2979
        e1000_config_dsp_after_link_change(hw, true);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2980
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2981
        /* We have a M88E1000 PHY and Auto-Neg is enabled.  If we
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2982
         * have Si on board that is 82544 or newer, Auto
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2983
         * Speed Detection takes care of MAC speed/duplex
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2984
         * configuration.  So we only need to configure Collision
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2985
         * Distance in the MAC.  Otherwise, we need to force
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2986
         * speed/duplex on the MAC to the current PHY speed/duplex
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2987
         * settings.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2988
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2989
        if (hw->mac_type >= e1000_82544)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2990
            e1000_config_collision_dist(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2991
        else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2992
            ret_val = e1000_config_mac_to_phy(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2993
            if (ret_val) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2994
                DEBUGOUT("Error configuring MAC to PHY settings\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2995
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2996
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2997
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2998
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  2999
        /* Configure Flow Control now that Auto-Neg has completed. First, we
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3000
         * need to restore the desired flow control settings because we may
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3001
         * have had to re-autoneg with a different link partner.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3002
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3003
        ret_val = e1000_config_fc_after_link_up(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3004
        if (ret_val) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3005
            DEBUGOUT("Error configuring flow control\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3006
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3007
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3008
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3009
        /* At this point we know that we are on copper and we have
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3010
         * auto-negotiated link.  These are conditions for checking the link
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3011
         * partner capability register.  We use the link speed to determine if
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3012
         * TBI compatibility needs to be turned on or off.  If the link is not
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3013
         * at gigabit speed, then TBI compatibility is not needed.  If we are
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3014
         * at gigabit speed, we turn on TBI compatibility.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3015
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3016
        if (hw->tbi_compatibility_en) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3017
            u16 speed, duplex;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3018
            ret_val = e1000_get_speed_and_duplex(hw, &speed, &duplex);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3019
            if (ret_val) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3020
                DEBUGOUT("Error getting link speed and duplex\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3021
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3022
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3023
            if (speed != SPEED_1000) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3024
                /* If link speed is not set to gigabit speed, we do not need
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3025
                 * to enable TBI compatibility.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3026
                 */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3027
                if (hw->tbi_compatibility_on) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3028
                    /* If we previously were in the mode, turn it off. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3029
                    rctl = er32(RCTL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3030
                    rctl &= ~E1000_RCTL_SBP;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3031
                    ew32(RCTL, rctl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3032
                    hw->tbi_compatibility_on = false;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3033
                }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3034
            } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3035
                /* If TBI compatibility is was previously off, turn it on. For
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3036
                 * compatibility with a TBI link partner, we will store bad
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3037
                 * packets. Some frames have an additional byte on the end and
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3038
                 * will look like CRC errors to to the hardware.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3039
                 */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3040
                if (!hw->tbi_compatibility_on) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3041
                    hw->tbi_compatibility_on = true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3042
                    rctl = er32(RCTL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3043
                    rctl |= E1000_RCTL_SBP;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3044
                    ew32(RCTL, rctl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3045
                }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3046
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3047
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3048
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3049
    /* If we don't have link (auto-negotiation failed or link partner cannot
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3050
     * auto-negotiate), the cable is plugged in (we have signal), and our
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3051
     * link partner is not trying to auto-negotiate with us (we are receiving
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3052
     * idles or data), we need to force link up. We also need to give
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3053
     * auto-negotiation time to complete, in case the cable was just plugged
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3054
     * in. The autoneg_failed flag does this.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3055
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3056
    else if ((((hw->media_type == e1000_media_type_fiber) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3057
              ((ctrl & E1000_CTRL_SWDPIN1) == signal)) ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3058
              (hw->media_type == e1000_media_type_internal_serdes)) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3059
              (!(status & E1000_STATUS_LU)) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3060
              (!(rxcw & E1000_RXCW_C))) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3061
        if (hw->autoneg_failed == 0) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3062
            hw->autoneg_failed = 1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3063
            return 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3064
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3065
        DEBUGOUT("NOT RXing /C/, disable AutoNeg and force link.\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3066
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3067
        /* Disable auto-negotiation in the TXCW register */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3068
        ew32(TXCW, (hw->txcw & ~E1000_TXCW_ANE));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3069
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3070
        /* Force link-up and also force full-duplex. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3071
        ctrl = er32(CTRL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3072
        ctrl |= (E1000_CTRL_SLU | E1000_CTRL_FD);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3073
        ew32(CTRL, ctrl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3074
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3075
        /* Configure Flow Control after forcing link up. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3076
        ret_val = e1000_config_fc_after_link_up(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3077
        if (ret_val) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3078
            DEBUGOUT("Error configuring flow control\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3079
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3080
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3081
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3082
    /* If we are forcing link and we are receiving /C/ ordered sets, re-enable
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3083
     * auto-negotiation in the TXCW register and disable forced link in the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3084
     * Device Control register in an attempt to auto-negotiate with our link
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3085
     * partner.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3086
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3087
    else if (((hw->media_type == e1000_media_type_fiber) ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3088
              (hw->media_type == e1000_media_type_internal_serdes)) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3089
              (ctrl & E1000_CTRL_SLU) && (rxcw & E1000_RXCW_C)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3090
        DEBUGOUT("RXing /C/, enable AutoNeg and stop forcing link.\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3091
        ew32(TXCW, hw->txcw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3092
        ew32(CTRL, (ctrl & ~E1000_CTRL_SLU));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3093
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3094
        hw->serdes_link_down = false;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3095
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3096
    /* If we force link for non-auto-negotiation switch, check link status
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3097
     * based on MAC synchronization for internal serdes media type.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3098
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3099
    else if ((hw->media_type == e1000_media_type_internal_serdes) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3100
             !(E1000_TXCW_ANE & er32(TXCW))) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3101
        /* SYNCH bit and IV bit are sticky. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3102
        udelay(10);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3103
        if (E1000_RXCW_SYNCH & er32(RXCW)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3104
            if (!(rxcw & E1000_RXCW_IV)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3105
                hw->serdes_link_down = false;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3106
                DEBUGOUT("SERDES: Link is up.\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3107
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3108
        } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3109
            hw->serdes_link_down = true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3110
            DEBUGOUT("SERDES: Link is down.\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3111
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3112
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3113
    if ((hw->media_type == e1000_media_type_internal_serdes) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3114
        (E1000_TXCW_ANE & er32(TXCW))) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3115
        hw->serdes_link_down = !(E1000_STATUS_LU & er32(STATUS));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3116
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3117
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3118
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3119
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3120
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3121
 * Detects the current speed and duplex settings of the hardware.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3122
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3123
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3124
 * speed - Speed of the connection
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3125
 * duplex - Duplex setting of the connection
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3126
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3127
s32 e1000_get_speed_and_duplex(struct e1000_hw *hw, u16 *speed, u16 *duplex)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3128
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3129
    u32 status;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3130
    s32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3131
    u16 phy_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3132
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3133
    DEBUGFUNC("e1000_get_speed_and_duplex");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3134
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3135
    if (hw->mac_type >= e1000_82543) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3136
        status = er32(STATUS);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3137
        if (status & E1000_STATUS_SPEED_1000) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3138
            *speed = SPEED_1000;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3139
            DEBUGOUT("1000 Mbs, ");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3140
        } else if (status & E1000_STATUS_SPEED_100) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3141
            *speed = SPEED_100;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3142
            DEBUGOUT("100 Mbs, ");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3143
        } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3144
            *speed = SPEED_10;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3145
            DEBUGOUT("10 Mbs, ");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3146
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3147
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3148
        if (status & E1000_STATUS_FD) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3149
            *duplex = FULL_DUPLEX;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3150
            DEBUGOUT("Full Duplex\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3151
        } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3152
            *duplex = HALF_DUPLEX;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3153
            DEBUGOUT(" Half Duplex\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3154
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3155
    } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3156
        DEBUGOUT("1000 Mbs, Full Duplex\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3157
        *speed = SPEED_1000;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3158
        *duplex = FULL_DUPLEX;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3159
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3160
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3161
    /* IGP01 PHY may advertise full duplex operation after speed downgrade even
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3162
     * if it is operating at half duplex.  Here we set the duplex settings to
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3163
     * match the duplex in the link partner's capabilities.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3164
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3165
    if (hw->phy_type == e1000_phy_igp && hw->speed_downgraded) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3166
        ret_val = e1000_read_phy_reg(hw, PHY_AUTONEG_EXP, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3167
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3168
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3169
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3170
        if (!(phy_data & NWAY_ER_LP_NWAY_CAPS))
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3171
            *duplex = HALF_DUPLEX;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3172
        else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3173
            ret_val = e1000_read_phy_reg(hw, PHY_LP_ABILITY, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3174
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3175
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3176
            if ((*speed == SPEED_100 && !(phy_data & NWAY_LPAR_100TX_FD_CAPS)) ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3177
               (*speed == SPEED_10 && !(phy_data & NWAY_LPAR_10T_FD_CAPS)))
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3178
                *duplex = HALF_DUPLEX;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3179
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3180
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3181
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3182
    if ((hw->mac_type == e1000_80003es2lan) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3183
        (hw->media_type == e1000_media_type_copper)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3184
        if (*speed == SPEED_1000)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3185
            ret_val = e1000_configure_kmrn_for_1000(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3186
        else
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3187
            ret_val = e1000_configure_kmrn_for_10_100(hw, *duplex);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3188
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3189
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3190
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3191
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3192
    if ((hw->phy_type == e1000_phy_igp_3) && (*speed == SPEED_1000)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3193
        ret_val = e1000_kumeran_lock_loss_workaround(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3194
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3195
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3196
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3197
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3198
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3199
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3200
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3201
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3202
* Blocks until autoneg completes or times out (~4.5 seconds)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3203
*
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3204
* hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3205
******************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3206
static s32 e1000_wait_autoneg(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3207
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3208
    s32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3209
    u16 i;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3210
    u16 phy_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3211
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3212
    DEBUGFUNC("e1000_wait_autoneg");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3213
    DEBUGOUT("Waiting for Auto-Neg to complete.\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3214
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3215
    /* We will wait for autoneg to complete or 4.5 seconds to expire. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3216
    for (i = PHY_AUTO_NEG_TIME; i > 0; i--) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3217
        /* Read the MII Status Register and wait for Auto-Neg
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3218
         * Complete bit to be set.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3219
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3220
        ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3221
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3222
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3223
        ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3224
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3225
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3226
        if (phy_data & MII_SR_AUTONEG_COMPLETE) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3227
            return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3228
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3229
        msleep(100);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3230
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3231
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3232
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3233
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3234
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3235
* Raises the Management Data Clock
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3236
*
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3237
* hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3238
* ctrl - Device control register's current value
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3239
******************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3240
static void e1000_raise_mdi_clk(struct e1000_hw *hw, u32 *ctrl)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3241
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3242
    /* Raise the clock input to the Management Data Clock (by setting the MDC
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3243
     * bit), and then delay 10 microseconds.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3244
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3245
    ew32(CTRL, (*ctrl | E1000_CTRL_MDC));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3246
    E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3247
    udelay(10);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3248
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3249
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3250
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3251
* Lowers the Management Data Clock
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3252
*
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3253
* hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3254
* ctrl - Device control register's current value
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3255
******************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3256
static void e1000_lower_mdi_clk(struct e1000_hw *hw, u32 *ctrl)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3257
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3258
    /* Lower the clock input to the Management Data Clock (by clearing the MDC
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3259
     * bit), and then delay 10 microseconds.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3260
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3261
    ew32(CTRL, (*ctrl & ~E1000_CTRL_MDC));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3262
    E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3263
    udelay(10);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3264
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3265
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3266
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3267
* Shifts data bits out to the PHY
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3268
*
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3269
* hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3270
* data - Data to send out to the PHY
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3271
* count - Number of bits to shift out
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3272
*
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3273
* Bits are shifted out in MSB to LSB order.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3274
******************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3275
static void e1000_shift_out_mdi_bits(struct e1000_hw *hw, u32 data, u16 count)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3276
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3277
    u32 ctrl;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3278
    u32 mask;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3279
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3280
    /* We need to shift "count" number of bits out to the PHY. So, the value
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3281
     * in the "data" parameter will be shifted out to the PHY one bit at a
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3282
     * time. In order to do this, "data" must be broken down into bits.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3283
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3284
    mask = 0x01;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3285
    mask <<= (count - 1);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3286
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3287
    ctrl = er32(CTRL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3288
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3289
    /* Set MDIO_DIR and MDC_DIR direction bits to be used as output pins. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3290
    ctrl |= (E1000_CTRL_MDIO_DIR | E1000_CTRL_MDC_DIR);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3291
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3292
    while (mask) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3293
        /* A "1" is shifted out to the PHY by setting the MDIO bit to "1" and
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3294
         * then raising and lowering the Management Data Clock. A "0" is
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3295
         * shifted out to the PHY by setting the MDIO bit to "0" and then
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3296
         * raising and lowering the clock.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3297
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3298
        if (data & mask)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3299
            ctrl |= E1000_CTRL_MDIO;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3300
        else
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3301
            ctrl &= ~E1000_CTRL_MDIO;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3302
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3303
        ew32(CTRL, ctrl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3304
        E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3305
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3306
        udelay(10);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3307
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3308
        e1000_raise_mdi_clk(hw, &ctrl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3309
        e1000_lower_mdi_clk(hw, &ctrl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3310
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3311
        mask = mask >> 1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3312
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3313
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3314
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3315
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3316
* Shifts data bits in from the PHY
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3317
*
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3318
* hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3319
*
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3320
* Bits are shifted in in MSB to LSB order.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3321
******************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3322
static u16 e1000_shift_in_mdi_bits(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3323
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3324
    u32 ctrl;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3325
    u16 data = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3326
    u8 i;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3327
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3328
    /* In order to read a register from the PHY, we need to shift in a total
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3329
     * of 18 bits from the PHY. The first two bit (turnaround) times are used
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3330
     * to avoid contention on the MDIO pin when a read operation is performed.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3331
     * These two bits are ignored by us and thrown away. Bits are "shifted in"
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3332
     * by raising the input to the Management Data Clock (setting the MDC bit),
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3333
     * and then reading the value of the MDIO bit.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3334
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3335
    ctrl = er32(CTRL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3336
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3337
    /* Clear MDIO_DIR (SWDPIO1) to indicate this bit is to be used as input. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3338
    ctrl &= ~E1000_CTRL_MDIO_DIR;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3339
    ctrl &= ~E1000_CTRL_MDIO;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3340
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3341
    ew32(CTRL, ctrl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3342
    E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3343
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3344
    /* Raise and Lower the clock before reading in the data. This accounts for
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3345
     * the turnaround bits. The first clock occurred when we clocked out the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3346
     * last bit of the Register Address.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3347
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3348
    e1000_raise_mdi_clk(hw, &ctrl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3349
    e1000_lower_mdi_clk(hw, &ctrl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3350
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3351
    for (data = 0, i = 0; i < 16; i++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3352
        data = data << 1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3353
        e1000_raise_mdi_clk(hw, &ctrl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3354
        ctrl = er32(CTRL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3355
        /* Check to see if we shifted in a "1". */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3356
        if (ctrl & E1000_CTRL_MDIO)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3357
            data |= 1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3358
        e1000_lower_mdi_clk(hw, &ctrl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3359
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3360
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3361
    e1000_raise_mdi_clk(hw, &ctrl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3362
    e1000_lower_mdi_clk(hw, &ctrl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3363
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3364
    return data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3365
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3366
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3367
static s32 e1000_swfw_sync_acquire(struct e1000_hw *hw, u16 mask)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3368
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3369
    u32 swfw_sync = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3370
    u32 swmask = mask;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3371
    u32 fwmask = mask << 16;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3372
    s32 timeout = 200;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3373
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3374
    DEBUGFUNC("e1000_swfw_sync_acquire");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3375
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3376
    if (hw->swfwhw_semaphore_present)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3377
        return e1000_get_software_flag(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3378
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3379
    if (!hw->swfw_sync_present)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3380
        return e1000_get_hw_eeprom_semaphore(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3381
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3382
    while (timeout) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3383
            if (e1000_get_hw_eeprom_semaphore(hw))
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3384
                return -E1000_ERR_SWFW_SYNC;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3385
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3386
            swfw_sync = er32(SW_FW_SYNC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3387
            if (!(swfw_sync & (fwmask | swmask))) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3388
                break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3389
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3390
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3391
            /* firmware currently using resource (fwmask) */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3392
            /* or other software thread currently using resource (swmask) */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3393
            e1000_put_hw_eeprom_semaphore(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3394
            mdelay(5);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3395
            timeout--;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3396
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3397
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3398
    if (!timeout) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3399
        DEBUGOUT("Driver can't access resource, SW_FW_SYNC timeout.\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3400
        return -E1000_ERR_SWFW_SYNC;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3401
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3402
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3403
    swfw_sync |= swmask;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3404
    ew32(SW_FW_SYNC, swfw_sync);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3405
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3406
    e1000_put_hw_eeprom_semaphore(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3407
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3408
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3409
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3410
static void e1000_swfw_sync_release(struct e1000_hw *hw, u16 mask)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3411
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3412
    u32 swfw_sync;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3413
    u32 swmask = mask;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3414
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3415
    DEBUGFUNC("e1000_swfw_sync_release");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3416
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3417
    if (hw->swfwhw_semaphore_present) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3418
        e1000_release_software_flag(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3419
        return;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3420
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3421
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3422
    if (!hw->swfw_sync_present) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3423
        e1000_put_hw_eeprom_semaphore(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3424
        return;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3425
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3426
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3427
    /* if (e1000_get_hw_eeprom_semaphore(hw))
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3428
     *    return -E1000_ERR_SWFW_SYNC; */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3429
    while (e1000_get_hw_eeprom_semaphore(hw) != E1000_SUCCESS);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3430
        /* empty */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3431
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3432
    swfw_sync = er32(SW_FW_SYNC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3433
    swfw_sync &= ~swmask;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3434
    ew32(SW_FW_SYNC, swfw_sync);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3435
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3436
    e1000_put_hw_eeprom_semaphore(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3437
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3438
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3439
/*****************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3440
* Reads the value from a PHY register, if the value is on a specific non zero
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3441
* page, sets the page first.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3442
* hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3443
* reg_addr - address of the PHY register to read
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3444
******************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3445
s32 e1000_read_phy_reg(struct e1000_hw *hw, u32 reg_addr, u16 *phy_data)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3446
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3447
    u32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3448
    u16 swfw;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3449
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3450
    DEBUGFUNC("e1000_read_phy_reg");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3451
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3452
    if ((hw->mac_type == e1000_80003es2lan) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3453
        (er32(STATUS) & E1000_STATUS_FUNC_1)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3454
        swfw = E1000_SWFW_PHY1_SM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3455
    } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3456
        swfw = E1000_SWFW_PHY0_SM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3457
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3458
    if (e1000_swfw_sync_acquire(hw, swfw))
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3459
        return -E1000_ERR_SWFW_SYNC;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3460
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3461
    if ((hw->phy_type == e1000_phy_igp ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3462
        hw->phy_type == e1000_phy_igp_3 ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3463
        hw->phy_type == e1000_phy_igp_2) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3464
       (reg_addr > MAX_PHY_MULTI_PAGE_REG)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3465
        ret_val = e1000_write_phy_reg_ex(hw, IGP01E1000_PHY_PAGE_SELECT,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3466
                                         (u16)reg_addr);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3467
        if (ret_val) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3468
            e1000_swfw_sync_release(hw, swfw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3469
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3470
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3471
    } else if (hw->phy_type == e1000_phy_gg82563) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3472
        if (((reg_addr & MAX_PHY_REG_ADDRESS) > MAX_PHY_MULTI_PAGE_REG) ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3473
            (hw->mac_type == e1000_80003es2lan)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3474
            /* Select Configuration Page */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3475
            if ((reg_addr & MAX_PHY_REG_ADDRESS) < GG82563_MIN_ALT_REG) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3476
                ret_val = e1000_write_phy_reg_ex(hw, GG82563_PHY_PAGE_SELECT,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3477
                          (u16)((u16)reg_addr >> GG82563_PAGE_SHIFT));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3478
            } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3479
                /* Use Alternative Page Select register to access
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3480
                 * registers 30 and 31
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3481
                 */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3482
                ret_val = e1000_write_phy_reg_ex(hw,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3483
                                                 GG82563_PHY_PAGE_SELECT_ALT,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3484
                          (u16)((u16)reg_addr >> GG82563_PAGE_SHIFT));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3485
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3486
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3487
            if (ret_val) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3488
                e1000_swfw_sync_release(hw, swfw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3489
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3490
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3491
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3492
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3493
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3494
    ret_val = e1000_read_phy_reg_ex(hw, MAX_PHY_REG_ADDRESS & reg_addr,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3495
                                    phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3496
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3497
    e1000_swfw_sync_release(hw, swfw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3498
    return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3499
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3500
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3501
static s32 e1000_read_phy_reg_ex(struct e1000_hw *hw, u32 reg_addr,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3502
				 u16 *phy_data)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3503
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3504
    u32 i;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3505
    u32 mdic = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3506
    const u32 phy_addr = 1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3507
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3508
    DEBUGFUNC("e1000_read_phy_reg_ex");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3509
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3510
    if (reg_addr > MAX_PHY_REG_ADDRESS) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3511
        DEBUGOUT1("PHY Address %d is out of range\n", reg_addr);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3512
        return -E1000_ERR_PARAM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3513
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3514
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3515
    if (hw->mac_type > e1000_82543) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3516
        /* Set up Op-code, Phy Address, and register address in the MDI
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3517
         * Control register.  The MAC will take care of interfacing with the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3518
         * PHY to retrieve the desired data.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3519
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3520
        mdic = ((reg_addr << E1000_MDIC_REG_SHIFT) |
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3521
                (phy_addr << E1000_MDIC_PHY_SHIFT) |
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3522
                (E1000_MDIC_OP_READ));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3523
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3524
        ew32(MDIC, mdic);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3525
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3526
        /* Poll the ready bit to see if the MDI read completed */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3527
        for (i = 0; i < 64; i++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3528
            udelay(50);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3529
            mdic = er32(MDIC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3530
            if (mdic & E1000_MDIC_READY) break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3531
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3532
        if (!(mdic & E1000_MDIC_READY)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3533
            DEBUGOUT("MDI Read did not complete\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3534
            return -E1000_ERR_PHY;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3535
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3536
        if (mdic & E1000_MDIC_ERROR) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3537
            DEBUGOUT("MDI Error\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3538
            return -E1000_ERR_PHY;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3539
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3540
        *phy_data = (u16)mdic;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3541
    } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3542
        /* We must first send a preamble through the MDIO pin to signal the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3543
         * beginning of an MII instruction.  This is done by sending 32
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3544
         * consecutive "1" bits.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3545
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3546
        e1000_shift_out_mdi_bits(hw, PHY_PREAMBLE, PHY_PREAMBLE_SIZE);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3547
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3548
        /* Now combine the next few fields that are required for a read
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3549
         * operation.  We use this method instead of calling the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3550
         * e1000_shift_out_mdi_bits routine five different times. The format of
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3551
         * a MII read instruction consists of a shift out of 14 bits and is
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3552
         * defined as follows:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3553
         *    <Preamble><SOF><Op Code><Phy Addr><Reg Addr>
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3554
         * followed by a shift in of 18 bits.  This first two bits shifted in
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3555
         * are TurnAround bits used to avoid contention on the MDIO pin when a
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3556
         * READ operation is performed.  These two bits are thrown away
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3557
         * followed by a shift in of 16 bits which contains the desired data.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3558
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3559
        mdic = ((reg_addr) | (phy_addr << 5) |
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3560
                (PHY_OP_READ << 10) | (PHY_SOF << 12));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3561
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3562
        e1000_shift_out_mdi_bits(hw, mdic, 14);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3563
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3564
        /* Now that we've shifted out the read command to the MII, we need to
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3565
         * "shift in" the 16-bit value (18 total bits) of the requested PHY
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3566
         * register address.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3567
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3568
        *phy_data = e1000_shift_in_mdi_bits(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3569
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3570
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3571
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3572
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3573
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3574
* Writes a value to a PHY register
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3575
*
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3576
* hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3577
* reg_addr - address of the PHY register to write
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3578
* data - data to write to the PHY
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3579
******************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3580
s32 e1000_write_phy_reg(struct e1000_hw *hw, u32 reg_addr, u16 phy_data)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3581
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3582
    u32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3583
    u16 swfw;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3584
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3585
    DEBUGFUNC("e1000_write_phy_reg");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3586
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3587
    if ((hw->mac_type == e1000_80003es2lan) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3588
        (er32(STATUS) & E1000_STATUS_FUNC_1)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3589
        swfw = E1000_SWFW_PHY1_SM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3590
    } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3591
        swfw = E1000_SWFW_PHY0_SM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3592
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3593
    if (e1000_swfw_sync_acquire(hw, swfw))
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3594
        return -E1000_ERR_SWFW_SYNC;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3595
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3596
    if ((hw->phy_type == e1000_phy_igp ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3597
        hw->phy_type == e1000_phy_igp_3 ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3598
        hw->phy_type == e1000_phy_igp_2) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3599
       (reg_addr > MAX_PHY_MULTI_PAGE_REG)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3600
        ret_val = e1000_write_phy_reg_ex(hw, IGP01E1000_PHY_PAGE_SELECT,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3601
                                         (u16)reg_addr);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3602
        if (ret_val) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3603
            e1000_swfw_sync_release(hw, swfw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3604
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3605
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3606
    } else if (hw->phy_type == e1000_phy_gg82563) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3607
        if (((reg_addr & MAX_PHY_REG_ADDRESS) > MAX_PHY_MULTI_PAGE_REG) ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3608
            (hw->mac_type == e1000_80003es2lan)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3609
            /* Select Configuration Page */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3610
            if ((reg_addr & MAX_PHY_REG_ADDRESS) < GG82563_MIN_ALT_REG) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3611
                ret_val = e1000_write_phy_reg_ex(hw, GG82563_PHY_PAGE_SELECT,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3612
                          (u16)((u16)reg_addr >> GG82563_PAGE_SHIFT));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3613
            } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3614
                /* Use Alternative Page Select register to access
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3615
                 * registers 30 and 31
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3616
                 */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3617
                ret_val = e1000_write_phy_reg_ex(hw,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3618
                                                 GG82563_PHY_PAGE_SELECT_ALT,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3619
                          (u16)((u16)reg_addr >> GG82563_PAGE_SHIFT));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3620
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3621
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3622
            if (ret_val) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3623
                e1000_swfw_sync_release(hw, swfw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3624
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3625
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3626
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3627
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3628
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3629
    ret_val = e1000_write_phy_reg_ex(hw, MAX_PHY_REG_ADDRESS & reg_addr,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3630
                                     phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3631
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3632
    e1000_swfw_sync_release(hw, swfw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3633
    return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3634
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3635
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3636
static s32 e1000_write_phy_reg_ex(struct e1000_hw *hw, u32 reg_addr,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3637
				  u16 phy_data)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3638
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3639
    u32 i;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3640
    u32 mdic = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3641
    const u32 phy_addr = 1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3642
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3643
    DEBUGFUNC("e1000_write_phy_reg_ex");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3644
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3645
    if (reg_addr > MAX_PHY_REG_ADDRESS) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3646
        DEBUGOUT1("PHY Address %d is out of range\n", reg_addr);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3647
        return -E1000_ERR_PARAM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3648
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3649
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3650
    if (hw->mac_type > e1000_82543) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3651
        /* Set up Op-code, Phy Address, register address, and data intended
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3652
         * for the PHY register in the MDI Control register.  The MAC will take
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3653
         * care of interfacing with the PHY to send the desired data.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3654
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3655
        mdic = (((u32)phy_data) |
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3656
                (reg_addr << E1000_MDIC_REG_SHIFT) |
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3657
                (phy_addr << E1000_MDIC_PHY_SHIFT) |
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3658
                (E1000_MDIC_OP_WRITE));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3659
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3660
        ew32(MDIC, mdic);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3661
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3662
        /* Poll the ready bit to see if the MDI read completed */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3663
        for (i = 0; i < 641; i++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3664
            udelay(5);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3665
            mdic = er32(MDIC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3666
            if (mdic & E1000_MDIC_READY) break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3667
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3668
        if (!(mdic & E1000_MDIC_READY)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3669
            DEBUGOUT("MDI Write did not complete\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3670
            return -E1000_ERR_PHY;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3671
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3672
    } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3673
        /* We'll need to use the SW defined pins to shift the write command
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3674
         * out to the PHY. We first send a preamble to the PHY to signal the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3675
         * beginning of the MII instruction.  This is done by sending 32
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3676
         * consecutive "1" bits.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3677
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3678
        e1000_shift_out_mdi_bits(hw, PHY_PREAMBLE, PHY_PREAMBLE_SIZE);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3679
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3680
        /* Now combine the remaining required fields that will indicate a
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3681
         * write operation. We use this method instead of calling the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3682
         * e1000_shift_out_mdi_bits routine for each field in the command. The
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3683
         * format of a MII write instruction is as follows:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3684
         * <Preamble><SOF><Op Code><Phy Addr><Reg Addr><Turnaround><Data>.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3685
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3686
        mdic = ((PHY_TURNAROUND) | (reg_addr << 2) | (phy_addr << 7) |
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3687
                (PHY_OP_WRITE << 12) | (PHY_SOF << 14));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3688
        mdic <<= 16;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3689
        mdic |= (u32)phy_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3690
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3691
        e1000_shift_out_mdi_bits(hw, mdic, 32);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3692
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3693
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3694
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3695
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3696
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3697
static s32 e1000_read_kmrn_reg(struct e1000_hw *hw, u32 reg_addr, u16 *data)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3698
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3699
    u32 reg_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3700
    u16 swfw;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3701
    DEBUGFUNC("e1000_read_kmrn_reg");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3702
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3703
    if ((hw->mac_type == e1000_80003es2lan) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3704
        (er32(STATUS) & E1000_STATUS_FUNC_1)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3705
        swfw = E1000_SWFW_PHY1_SM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3706
    } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3707
        swfw = E1000_SWFW_PHY0_SM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3708
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3709
    if (e1000_swfw_sync_acquire(hw, swfw))
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3710
        return -E1000_ERR_SWFW_SYNC;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3711
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3712
    /* Write register address */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3713
    reg_val = ((reg_addr << E1000_KUMCTRLSTA_OFFSET_SHIFT) &
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3714
              E1000_KUMCTRLSTA_OFFSET) |
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3715
              E1000_KUMCTRLSTA_REN;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3716
    ew32(KUMCTRLSTA, reg_val);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3717
    udelay(2);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3718
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3719
    /* Read the data returned */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3720
    reg_val = er32(KUMCTRLSTA);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3721
    *data = (u16)reg_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3722
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3723
    e1000_swfw_sync_release(hw, swfw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3724
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3725
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3726
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3727
static s32 e1000_write_kmrn_reg(struct e1000_hw *hw, u32 reg_addr, u16 data)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3728
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3729
    u32 reg_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3730
    u16 swfw;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3731
    DEBUGFUNC("e1000_write_kmrn_reg");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3732
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3733
    if ((hw->mac_type == e1000_80003es2lan) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3734
        (er32(STATUS) & E1000_STATUS_FUNC_1)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3735
        swfw = E1000_SWFW_PHY1_SM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3736
    } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3737
        swfw = E1000_SWFW_PHY0_SM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3738
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3739
    if (e1000_swfw_sync_acquire(hw, swfw))
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3740
        return -E1000_ERR_SWFW_SYNC;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3741
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3742
    reg_val = ((reg_addr << E1000_KUMCTRLSTA_OFFSET_SHIFT) &
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3743
              E1000_KUMCTRLSTA_OFFSET) | data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3744
    ew32(KUMCTRLSTA, reg_val);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3745
    udelay(2);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3746
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3747
    e1000_swfw_sync_release(hw, swfw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3748
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3749
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3750
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3751
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3752
* Returns the PHY to the power-on reset state
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3753
*
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3754
* hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3755
******************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3756
s32 e1000_phy_hw_reset(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3757
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3758
    u32 ctrl, ctrl_ext;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3759
    u32 led_ctrl;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3760
    s32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3761
    u16 swfw;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3762
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3763
    DEBUGFUNC("e1000_phy_hw_reset");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3764
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3765
    /* In the case of the phy reset being blocked, it's not an error, we
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3766
     * simply return success without performing the reset. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3767
    ret_val = e1000_check_phy_reset_block(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3768
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3769
        return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3770
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3771
    DEBUGOUT("Resetting Phy...\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3772
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3773
    if (hw->mac_type > e1000_82543) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3774
        if ((hw->mac_type == e1000_80003es2lan) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3775
            (er32(STATUS) & E1000_STATUS_FUNC_1)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3776
            swfw = E1000_SWFW_PHY1_SM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3777
        } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3778
            swfw = E1000_SWFW_PHY0_SM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3779
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3780
        if (e1000_swfw_sync_acquire(hw, swfw)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3781
            DEBUGOUT("Unable to acquire swfw sync\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3782
            return -E1000_ERR_SWFW_SYNC;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3783
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3784
        /* Read the device control register and assert the E1000_CTRL_PHY_RST
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3785
         * bit. Then, take it out of reset.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3786
         * For pre-e1000_82571 hardware, we delay for 10ms between the assert
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3787
         * and deassert.  For e1000_82571 hardware and later, we instead delay
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3788
         * for 50us between and 10ms after the deassertion.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3789
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3790
        ctrl = er32(CTRL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3791
        ew32(CTRL, ctrl | E1000_CTRL_PHY_RST);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3792
        E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3793
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3794
        if (hw->mac_type < e1000_82571)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3795
            msleep(10);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3796
        else
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3797
            udelay(100);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3798
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3799
        ew32(CTRL, ctrl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3800
        E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3801
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3802
        if (hw->mac_type >= e1000_82571)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3803
            mdelay(10);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3804
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3805
        e1000_swfw_sync_release(hw, swfw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3806
    } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3807
        /* Read the Extended Device Control Register, assert the PHY_RESET_DIR
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3808
         * bit to put the PHY into reset. Then, take it out of reset.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3809
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3810
        ctrl_ext = er32(CTRL_EXT);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3811
        ctrl_ext |= E1000_CTRL_EXT_SDP4_DIR;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3812
        ctrl_ext &= ~E1000_CTRL_EXT_SDP4_DATA;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3813
        ew32(CTRL_EXT, ctrl_ext);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3814
        E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3815
        msleep(10);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3816
        ctrl_ext |= E1000_CTRL_EXT_SDP4_DATA;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3817
        ew32(CTRL_EXT, ctrl_ext);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3818
        E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3819
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3820
    udelay(150);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3821
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3822
    if ((hw->mac_type == e1000_82541) || (hw->mac_type == e1000_82547)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3823
        /* Configure activity LED after PHY reset */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3824
        led_ctrl = er32(LEDCTL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3825
        led_ctrl &= IGP_ACTIVITY_LED_MASK;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3826
        led_ctrl |= (IGP_ACTIVITY_LED_ENABLE | IGP_LED3_MODE);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3827
        ew32(LEDCTL, led_ctrl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3828
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3829
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3830
    /* Wait for FW to finish PHY configuration. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3831
    ret_val = e1000_get_phy_cfg_done(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3832
    if (ret_val != E1000_SUCCESS)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3833
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3834
    e1000_release_software_semaphore(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3835
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3836
    if ((hw->mac_type == e1000_ich8lan) && (hw->phy_type == e1000_phy_igp_3))
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3837
        ret_val = e1000_init_lcd_from_nvm(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3838
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3839
    return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3840
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3841
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3842
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3843
* Resets the PHY
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3844
*
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3845
* hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3846
*
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3847
* Sets bit 15 of the MII Control register
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3848
******************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3849
s32 e1000_phy_reset(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3850
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3851
    s32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3852
    u16 phy_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3853
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3854
    DEBUGFUNC("e1000_phy_reset");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3855
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3856
    /* In the case of the phy reset being blocked, it's not an error, we
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3857
     * simply return success without performing the reset. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3858
    ret_val = e1000_check_phy_reset_block(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3859
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3860
        return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3861
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3862
    switch (hw->phy_type) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3863
    case e1000_phy_igp:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3864
    case e1000_phy_igp_2:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3865
    case e1000_phy_igp_3:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3866
    case e1000_phy_ife:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3867
        ret_val = e1000_phy_hw_reset(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3868
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3869
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3870
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3871
    default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3872
        ret_val = e1000_read_phy_reg(hw, PHY_CTRL, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3873
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3874
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3875
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3876
        phy_data |= MII_CR_RESET;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3877
        ret_val = e1000_write_phy_reg(hw, PHY_CTRL, phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3878
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3879
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3880
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3881
        udelay(1);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3882
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3883
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3884
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3885
    if (hw->phy_type == e1000_phy_igp || hw->phy_type == e1000_phy_igp_2)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3886
        e1000_phy_init_script(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3887
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3888
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3889
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3890
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3891
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3892
* Work-around for 82566 power-down: on D3 entry-
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3893
* 1) disable gigabit link
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3894
* 2) write VR power-down enable
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3895
* 3) read it back
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3896
* if successful continue, else issue LCD reset and repeat
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3897
*
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3898
* hw - struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3899
******************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3900
void e1000_phy_powerdown_workaround(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3901
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3902
    s32 reg;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3903
    u16 phy_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3904
    s32 retry = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3905
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3906
    DEBUGFUNC("e1000_phy_powerdown_workaround");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3907
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3908
    if (hw->phy_type != e1000_phy_igp_3)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3909
        return;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3910
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3911
    do {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3912
        /* Disable link */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3913
        reg = er32(PHY_CTRL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3914
        ew32(PHY_CTRL, reg | E1000_PHY_CTRL_GBE_DISABLE |
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3915
                        E1000_PHY_CTRL_NOND0A_GBE_DISABLE);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3916
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3917
        /* Write VR power-down enable - bits 9:8 should be 10b */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3918
        e1000_read_phy_reg(hw, IGP3_VR_CTRL, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3919
        phy_data |= (1 << 9);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3920
        phy_data &= ~(1 << 8);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3921
        e1000_write_phy_reg(hw, IGP3_VR_CTRL, phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3922
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3923
        /* Read it back and test */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3924
        e1000_read_phy_reg(hw, IGP3_VR_CTRL, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3925
        if (((phy_data & IGP3_VR_CTRL_MODE_MASK) == IGP3_VR_CTRL_MODE_SHUT) || retry)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3926
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3927
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3928
        /* Issue PHY reset and repeat at most one more time */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3929
        reg = er32(CTRL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3930
        ew32(CTRL, reg | E1000_CTRL_PHY_RST);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3931
        retry++;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3932
    } while (retry);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3933
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3934
    return;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3935
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3936
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3937
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3938
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3939
* Work-around for 82566 Kumeran PCS lock loss:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3940
* On link status change (i.e. PCI reset, speed change) and link is up and
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3941
* speed is gigabit-
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3942
* 0) if workaround is optionally disabled do nothing
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3943
* 1) wait 1ms for Kumeran link to come up
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3944
* 2) check Kumeran Diagnostic register PCS lock loss bit
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3945
* 3) if not set the link is locked (all is good), otherwise...
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3946
* 4) reset the PHY
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3947
* 5) repeat up to 10 times
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3948
* Note: this is only called for IGP3 copper when speed is 1gb.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3949
*
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3950
* hw - struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3951
******************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3952
static s32 e1000_kumeran_lock_loss_workaround(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3953
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3954
    s32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3955
    s32 reg;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3956
    s32 cnt;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3957
    u16 phy_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3958
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3959
    if (hw->kmrn_lock_loss_workaround_disabled)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3960
        return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3961
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3962
    /* Make sure link is up before proceeding.  If not just return.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3963
     * Attempting this while link is negotiating fouled up link
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3964
     * stability */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3965
    ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3966
    ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3967
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3968
    if (phy_data & MII_SR_LINK_STATUS) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3969
        for (cnt = 0; cnt < 10; cnt++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3970
            /* read once to clear */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3971
            ret_val = e1000_read_phy_reg(hw, IGP3_KMRN_DIAG, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3972
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3973
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3974
            /* and again to get new status */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3975
            ret_val = e1000_read_phy_reg(hw, IGP3_KMRN_DIAG, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3976
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3977
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3978
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3979
            /* check for PCS lock */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3980
            if (!(phy_data & IGP3_KMRN_DIAG_PCS_LOCK_LOSS))
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3981
                return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3982
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3983
            /* Issue PHY reset */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3984
            e1000_phy_hw_reset(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3985
            mdelay(5);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3986
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3987
        /* Disable GigE link negotiation */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3988
        reg = er32(PHY_CTRL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3989
        ew32(PHY_CTRL, reg | E1000_PHY_CTRL_GBE_DISABLE |
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3990
                        E1000_PHY_CTRL_NOND0A_GBE_DISABLE);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3991
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3992
        /* unable to acquire PCS lock */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3993
        return E1000_ERR_PHY;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3994
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3995
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3996
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3997
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3998
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  3999
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4000
* Probes the expected PHY address for known PHY IDs
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4001
*
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4002
* hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4003
******************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4004
static s32 e1000_detect_gig_phy(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4005
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4006
    s32 phy_init_status, ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4007
    u16 phy_id_high, phy_id_low;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4008
    bool match = false;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4009
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4010
    DEBUGFUNC("e1000_detect_gig_phy");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4011
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4012
    if (hw->phy_id != 0)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4013
        return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4014
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4015
    /* The 82571 firmware may still be configuring the PHY.  In this
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4016
     * case, we cannot access the PHY until the configuration is done.  So
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4017
     * we explicitly set the PHY values. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4018
    if (hw->mac_type == e1000_82571 ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4019
        hw->mac_type == e1000_82572) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4020
        hw->phy_id = IGP01E1000_I_PHY_ID;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4021
        hw->phy_type = e1000_phy_igp_2;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4022
        return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4023
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4024
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4025
    /* ESB-2 PHY reads require e1000_phy_gg82563 to be set because of a work-
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4026
     * around that forces PHY page 0 to be set or the reads fail.  The rest of
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4027
     * the code in this routine uses e1000_read_phy_reg to read the PHY ID.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4028
     * So for ESB-2 we need to have this set so our reads won't fail.  If the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4029
     * attached PHY is not a e1000_phy_gg82563, the routines below will figure
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4030
     * this out as well. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4031
    if (hw->mac_type == e1000_80003es2lan)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4032
        hw->phy_type = e1000_phy_gg82563;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4033
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4034
    /* Read the PHY ID Registers to identify which PHY is onboard. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4035
    ret_val = e1000_read_phy_reg(hw, PHY_ID1, &phy_id_high);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4036
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4037
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4038
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4039
    hw->phy_id = (u32)(phy_id_high << 16);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4040
    udelay(20);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4041
    ret_val = e1000_read_phy_reg(hw, PHY_ID2, &phy_id_low);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4042
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4043
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4044
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4045
    hw->phy_id |= (u32)(phy_id_low & PHY_REVISION_MASK);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4046
    hw->phy_revision = (u32)phy_id_low & ~PHY_REVISION_MASK;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4047
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4048
    switch (hw->mac_type) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4049
    case e1000_82543:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4050
        if (hw->phy_id == M88E1000_E_PHY_ID) match = true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4051
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4052
    case e1000_82544:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4053
        if (hw->phy_id == M88E1000_I_PHY_ID) match = true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4054
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4055
    case e1000_82540:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4056
    case e1000_82545:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4057
    case e1000_82545_rev_3:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4058
    case e1000_82546:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4059
    case e1000_82546_rev_3:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4060
        if (hw->phy_id == M88E1011_I_PHY_ID) match = true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4061
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4062
    case e1000_82541:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4063
    case e1000_82541_rev_2:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4064
    case e1000_82547:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4065
    case e1000_82547_rev_2:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4066
        if (hw->phy_id == IGP01E1000_I_PHY_ID) match = true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4067
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4068
    case e1000_82573:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4069
        if (hw->phy_id == M88E1111_I_PHY_ID) match = true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4070
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4071
    case e1000_80003es2lan:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4072
        if (hw->phy_id == GG82563_E_PHY_ID) match = true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4073
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4074
    case e1000_ich8lan:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4075
        if (hw->phy_id == IGP03E1000_E_PHY_ID) match = true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4076
        if (hw->phy_id == IFE_E_PHY_ID) match = true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4077
        if (hw->phy_id == IFE_PLUS_E_PHY_ID) match = true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4078
        if (hw->phy_id == IFE_C_E_PHY_ID) match = true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4079
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4080
    default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4081
        DEBUGOUT1("Invalid MAC type %d\n", hw->mac_type);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4082
        return -E1000_ERR_CONFIG;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4083
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4084
    phy_init_status = e1000_set_phy_type(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4085
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4086
    if ((match) && (phy_init_status == E1000_SUCCESS)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4087
        DEBUGOUT1("PHY ID 0x%X detected\n", hw->phy_id);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4088
        return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4089
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4090
    DEBUGOUT1("Invalid PHY ID 0x%X\n", hw->phy_id);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4091
    return -E1000_ERR_PHY;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4092
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4093
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4094
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4095
* Resets the PHY's DSP
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4096
*
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4097
* hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4098
******************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4099
static s32 e1000_phy_reset_dsp(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4100
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4101
    s32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4102
    DEBUGFUNC("e1000_phy_reset_dsp");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4103
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4104
    do {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4105
        if (hw->phy_type != e1000_phy_gg82563) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4106
            ret_val = e1000_write_phy_reg(hw, 29, 0x001d);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4107
            if (ret_val) break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4108
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4109
        ret_val = e1000_write_phy_reg(hw, 30, 0x00c1);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4110
        if (ret_val) break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4111
        ret_val = e1000_write_phy_reg(hw, 30, 0x0000);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4112
        if (ret_val) break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4113
        ret_val = E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4114
    } while (0);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4115
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4116
    return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4117
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4118
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4119
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4120
* Get PHY information from various PHY registers for igp PHY only.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4121
*
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4122
* hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4123
* phy_info - PHY information structure
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4124
******************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4125
static s32 e1000_phy_igp_get_info(struct e1000_hw *hw,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4126
				  struct e1000_phy_info *phy_info)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4127
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4128
    s32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4129
    u16 phy_data, min_length, max_length, average;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4130
    e1000_rev_polarity polarity;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4131
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4132
    DEBUGFUNC("e1000_phy_igp_get_info");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4133
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4134
    /* The downshift status is checked only once, after link is established,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4135
     * and it stored in the hw->speed_downgraded parameter. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4136
    phy_info->downshift = (e1000_downshift)hw->speed_downgraded;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4137
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4138
    /* IGP01E1000 does not need to support it. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4139
    phy_info->extended_10bt_distance = e1000_10bt_ext_dist_enable_normal;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4140
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4141
    /* IGP01E1000 always correct polarity reversal */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4142
    phy_info->polarity_correction = e1000_polarity_reversal_enabled;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4143
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4144
    /* Check polarity status */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4145
    ret_val = e1000_check_polarity(hw, &polarity);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4146
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4147
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4148
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4149
    phy_info->cable_polarity = polarity;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4150
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4151
    ret_val = e1000_read_phy_reg(hw, IGP01E1000_PHY_PORT_STATUS, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4152
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4153
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4154
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4155
    phy_info->mdix_mode = (e1000_auto_x_mode)((phy_data & IGP01E1000_PSSR_MDIX) >>
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4156
                          IGP01E1000_PSSR_MDIX_SHIFT);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4157
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4158
    if ((phy_data & IGP01E1000_PSSR_SPEED_MASK) ==
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4159
       IGP01E1000_PSSR_SPEED_1000MBPS) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4160
        /* Local/Remote Receiver Information are only valid at 1000 Mbps */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4161
        ret_val = e1000_read_phy_reg(hw, PHY_1000T_STATUS, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4162
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4163
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4164
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4165
        phy_info->local_rx = ((phy_data & SR_1000T_LOCAL_RX_STATUS) >>
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4166
                             SR_1000T_LOCAL_RX_STATUS_SHIFT) ?
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4167
                             e1000_1000t_rx_status_ok : e1000_1000t_rx_status_not_ok;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4168
        phy_info->remote_rx = ((phy_data & SR_1000T_REMOTE_RX_STATUS) >>
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4169
                              SR_1000T_REMOTE_RX_STATUS_SHIFT) ?
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4170
                              e1000_1000t_rx_status_ok : e1000_1000t_rx_status_not_ok;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4171
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4172
        /* Get cable length */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4173
        ret_val = e1000_get_cable_length(hw, &min_length, &max_length);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4174
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4175
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4176
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4177
        /* Translate to old method */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4178
        average = (max_length + min_length) / 2;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4179
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4180
        if (average <= e1000_igp_cable_length_50)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4181
            phy_info->cable_length = e1000_cable_length_50;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4182
        else if (average <= e1000_igp_cable_length_80)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4183
            phy_info->cable_length = e1000_cable_length_50_80;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4184
        else if (average <= e1000_igp_cable_length_110)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4185
            phy_info->cable_length = e1000_cable_length_80_110;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4186
        else if (average <= e1000_igp_cable_length_140)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4187
            phy_info->cable_length = e1000_cable_length_110_140;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4188
        else
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4189
            phy_info->cable_length = e1000_cable_length_140;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4190
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4191
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4192
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4193
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4194
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4195
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4196
* Get PHY information from various PHY registers for ife PHY only.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4197
*
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4198
* hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4199
* phy_info - PHY information structure
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4200
******************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4201
static s32 e1000_phy_ife_get_info(struct e1000_hw *hw,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4202
				  struct e1000_phy_info *phy_info)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4203
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4204
    s32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4205
    u16 phy_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4206
    e1000_rev_polarity polarity;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4207
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4208
    DEBUGFUNC("e1000_phy_ife_get_info");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4209
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4210
    phy_info->downshift = (e1000_downshift)hw->speed_downgraded;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4211
    phy_info->extended_10bt_distance = e1000_10bt_ext_dist_enable_normal;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4212
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4213
    ret_val = e1000_read_phy_reg(hw, IFE_PHY_SPECIAL_CONTROL, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4214
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4215
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4216
    phy_info->polarity_correction =
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4217
                        ((phy_data & IFE_PSC_AUTO_POLARITY_DISABLE) >>
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4218
                        IFE_PSC_AUTO_POLARITY_DISABLE_SHIFT) ?
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4219
                        e1000_polarity_reversal_disabled : e1000_polarity_reversal_enabled;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4220
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4221
    if (phy_info->polarity_correction == e1000_polarity_reversal_enabled) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4222
        ret_val = e1000_check_polarity(hw, &polarity);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4223
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4224
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4225
    } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4226
        /* Polarity is forced. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4227
        polarity = ((phy_data & IFE_PSC_FORCE_POLARITY) >>
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4228
                     IFE_PSC_FORCE_POLARITY_SHIFT) ?
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4229
                     e1000_rev_polarity_reversed : e1000_rev_polarity_normal;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4230
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4231
    phy_info->cable_polarity = polarity;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4232
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4233
    ret_val = e1000_read_phy_reg(hw, IFE_PHY_MDIX_CONTROL, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4234
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4235
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4236
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4237
    phy_info->mdix_mode = (e1000_auto_x_mode)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4238
                     ((phy_data & (IFE_PMC_AUTO_MDIX | IFE_PMC_FORCE_MDIX)) >>
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4239
                     IFE_PMC_MDIX_MODE_SHIFT);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4240
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4241
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4242
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4243
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4244
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4245
* Get PHY information from various PHY registers fot m88 PHY only.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4246
*
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4247
* hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4248
* phy_info - PHY information structure
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4249
******************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4250
static s32 e1000_phy_m88_get_info(struct e1000_hw *hw,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4251
				  struct e1000_phy_info *phy_info)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4252
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4253
    s32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4254
    u16 phy_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4255
    e1000_rev_polarity polarity;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4256
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4257
    DEBUGFUNC("e1000_phy_m88_get_info");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4258
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4259
    /* The downshift status is checked only once, after link is established,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4260
     * and it stored in the hw->speed_downgraded parameter. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4261
    phy_info->downshift = (e1000_downshift)hw->speed_downgraded;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4262
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4263
    ret_val = e1000_read_phy_reg(hw, M88E1000_PHY_SPEC_CTRL, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4264
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4265
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4266
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4267
    phy_info->extended_10bt_distance =
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4268
        ((phy_data & M88E1000_PSCR_10BT_EXT_DIST_ENABLE) >>
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4269
        M88E1000_PSCR_10BT_EXT_DIST_ENABLE_SHIFT) ?
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4270
        e1000_10bt_ext_dist_enable_lower : e1000_10bt_ext_dist_enable_normal;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4271
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4272
    phy_info->polarity_correction =
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4273
        ((phy_data & M88E1000_PSCR_POLARITY_REVERSAL) >>
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4274
        M88E1000_PSCR_POLARITY_REVERSAL_SHIFT) ?
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4275
        e1000_polarity_reversal_disabled : e1000_polarity_reversal_enabled;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4276
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4277
    /* Check polarity status */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4278
    ret_val = e1000_check_polarity(hw, &polarity);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4279
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4280
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4281
    phy_info->cable_polarity = polarity;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4282
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4283
    ret_val = e1000_read_phy_reg(hw, M88E1000_PHY_SPEC_STATUS, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4284
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4285
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4286
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4287
    phy_info->mdix_mode = (e1000_auto_x_mode)((phy_data & M88E1000_PSSR_MDIX) >>
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4288
                          M88E1000_PSSR_MDIX_SHIFT);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4289
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4290
    if ((phy_data & M88E1000_PSSR_SPEED) == M88E1000_PSSR_1000MBS) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4291
        /* Cable Length Estimation and Local/Remote Receiver Information
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4292
         * are only valid at 1000 Mbps.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4293
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4294
        if (hw->phy_type != e1000_phy_gg82563) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4295
            phy_info->cable_length = (e1000_cable_length)((phy_data & M88E1000_PSSR_CABLE_LENGTH) >>
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4296
                                      M88E1000_PSSR_CABLE_LENGTH_SHIFT);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4297
        } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4298
            ret_val = e1000_read_phy_reg(hw, GG82563_PHY_DSP_DISTANCE,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4299
                                         &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4300
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4301
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4302
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4303
            phy_info->cable_length = (e1000_cable_length)(phy_data & GG82563_DSPD_CABLE_LENGTH);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4304
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4305
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4306
        ret_val = e1000_read_phy_reg(hw, PHY_1000T_STATUS, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4307
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4308
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4309
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4310
        phy_info->local_rx = ((phy_data & SR_1000T_LOCAL_RX_STATUS) >>
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4311
                             SR_1000T_LOCAL_RX_STATUS_SHIFT) ?
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4312
                             e1000_1000t_rx_status_ok : e1000_1000t_rx_status_not_ok;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4313
        phy_info->remote_rx = ((phy_data & SR_1000T_REMOTE_RX_STATUS) >>
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4314
                              SR_1000T_REMOTE_RX_STATUS_SHIFT) ?
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4315
                              e1000_1000t_rx_status_ok : e1000_1000t_rx_status_not_ok;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4316
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4317
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4318
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4319
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4320
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4321
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4322
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4323
* Get PHY information from various PHY registers
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4324
*
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4325
* hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4326
* phy_info - PHY information structure
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4327
******************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4328
s32 e1000_phy_get_info(struct e1000_hw *hw, struct e1000_phy_info *phy_info)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4329
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4330
    s32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4331
    u16 phy_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4332
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4333
    DEBUGFUNC("e1000_phy_get_info");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4334
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4335
    phy_info->cable_length = e1000_cable_length_undefined;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4336
    phy_info->extended_10bt_distance = e1000_10bt_ext_dist_enable_undefined;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4337
    phy_info->cable_polarity = e1000_rev_polarity_undefined;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4338
    phy_info->downshift = e1000_downshift_undefined;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4339
    phy_info->polarity_correction = e1000_polarity_reversal_undefined;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4340
    phy_info->mdix_mode = e1000_auto_x_mode_undefined;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4341
    phy_info->local_rx = e1000_1000t_rx_status_undefined;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4342
    phy_info->remote_rx = e1000_1000t_rx_status_undefined;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4343
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4344
    if (hw->media_type != e1000_media_type_copper) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4345
        DEBUGOUT("PHY info is only valid for copper media\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4346
        return -E1000_ERR_CONFIG;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4347
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4348
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4349
    ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4350
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4351
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4352
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4353
    ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4354
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4355
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4356
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4357
    if ((phy_data & MII_SR_LINK_STATUS) != MII_SR_LINK_STATUS) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4358
        DEBUGOUT("PHY info is only valid if link is up\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4359
        return -E1000_ERR_CONFIG;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4360
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4361
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4362
    if (hw->phy_type == e1000_phy_igp ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4363
        hw->phy_type == e1000_phy_igp_3 ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4364
        hw->phy_type == e1000_phy_igp_2)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4365
        return e1000_phy_igp_get_info(hw, phy_info);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4366
    else if (hw->phy_type == e1000_phy_ife)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4367
        return e1000_phy_ife_get_info(hw, phy_info);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4368
    else
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4369
        return e1000_phy_m88_get_info(hw, phy_info);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4370
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4371
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4372
s32 e1000_validate_mdi_setting(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4373
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4374
    DEBUGFUNC("e1000_validate_mdi_settings");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4375
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4376
    if (!hw->autoneg && (hw->mdix == 0 || hw->mdix == 3)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4377
        DEBUGOUT("Invalid MDI setting detected\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4378
        hw->mdix = 1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4379
        return -E1000_ERR_CONFIG;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4380
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4381
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4382
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4383
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4384
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4385
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4386
 * Sets up eeprom variables in the hw struct.  Must be called after mac_type
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4387
 * is configured.  Additionally, if this is ICH8, the flash controller GbE
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4388
 * registers must be mapped, or this will crash.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4389
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4390
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4391
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4392
s32 e1000_init_eeprom_params(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4393
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4394
    struct e1000_eeprom_info *eeprom = &hw->eeprom;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4395
    u32 eecd = er32(EECD);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4396
    s32 ret_val = E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4397
    u16 eeprom_size;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4398
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4399
    DEBUGFUNC("e1000_init_eeprom_params");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4400
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4401
    switch (hw->mac_type) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4402
    case e1000_82542_rev2_0:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4403
    case e1000_82542_rev2_1:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4404
    case e1000_82543:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4405
    case e1000_82544:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4406
        eeprom->type = e1000_eeprom_microwire;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4407
        eeprom->word_size = 64;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4408
        eeprom->opcode_bits = 3;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4409
        eeprom->address_bits = 6;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4410
        eeprom->delay_usec = 50;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4411
        eeprom->use_eerd = false;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4412
        eeprom->use_eewr = false;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4413
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4414
    case e1000_82540:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4415
    case e1000_82545:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4416
    case e1000_82545_rev_3:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4417
    case e1000_82546:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4418
    case e1000_82546_rev_3:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4419
        eeprom->type = e1000_eeprom_microwire;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4420
        eeprom->opcode_bits = 3;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4421
        eeprom->delay_usec = 50;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4422
        if (eecd & E1000_EECD_SIZE) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4423
            eeprom->word_size = 256;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4424
            eeprom->address_bits = 8;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4425
        } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4426
            eeprom->word_size = 64;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4427
            eeprom->address_bits = 6;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4428
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4429
        eeprom->use_eerd = false;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4430
        eeprom->use_eewr = false;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4431
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4432
    case e1000_82541:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4433
    case e1000_82541_rev_2:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4434
    case e1000_82547:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4435
    case e1000_82547_rev_2:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4436
        if (eecd & E1000_EECD_TYPE) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4437
            eeprom->type = e1000_eeprom_spi;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4438
            eeprom->opcode_bits = 8;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4439
            eeprom->delay_usec = 1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4440
            if (eecd & E1000_EECD_ADDR_BITS) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4441
                eeprom->page_size = 32;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4442
                eeprom->address_bits = 16;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4443
            } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4444
                eeprom->page_size = 8;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4445
                eeprom->address_bits = 8;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4446
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4447
        } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4448
            eeprom->type = e1000_eeprom_microwire;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4449
            eeprom->opcode_bits = 3;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4450
            eeprom->delay_usec = 50;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4451
            if (eecd & E1000_EECD_ADDR_BITS) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4452
                eeprom->word_size = 256;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4453
                eeprom->address_bits = 8;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4454
            } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4455
                eeprom->word_size = 64;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4456
                eeprom->address_bits = 6;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4457
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4458
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4459
        eeprom->use_eerd = false;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4460
        eeprom->use_eewr = false;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4461
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4462
    case e1000_82571:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4463
    case e1000_82572:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4464
        eeprom->type = e1000_eeprom_spi;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4465
        eeprom->opcode_bits = 8;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4466
        eeprom->delay_usec = 1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4467
        if (eecd & E1000_EECD_ADDR_BITS) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4468
            eeprom->page_size = 32;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4469
            eeprom->address_bits = 16;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4470
        } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4471
            eeprom->page_size = 8;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4472
            eeprom->address_bits = 8;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4473
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4474
        eeprom->use_eerd = false;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4475
        eeprom->use_eewr = false;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4476
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4477
    case e1000_82573:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4478
        eeprom->type = e1000_eeprom_spi;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4479
        eeprom->opcode_bits = 8;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4480
        eeprom->delay_usec = 1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4481
        if (eecd & E1000_EECD_ADDR_BITS) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4482
            eeprom->page_size = 32;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4483
            eeprom->address_bits = 16;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4484
        } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4485
            eeprom->page_size = 8;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4486
            eeprom->address_bits = 8;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4487
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4488
        eeprom->use_eerd = true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4489
        eeprom->use_eewr = true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4490
        if (!e1000_is_onboard_nvm_eeprom(hw)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4491
            eeprom->type = e1000_eeprom_flash;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4492
            eeprom->word_size = 2048;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4493
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4494
            /* Ensure that the Autonomous FLASH update bit is cleared due to
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4495
             * Flash update issue on parts which use a FLASH for NVM. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4496
            eecd &= ~E1000_EECD_AUPDEN;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4497
            ew32(EECD, eecd);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4498
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4499
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4500
    case e1000_80003es2lan:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4501
        eeprom->type = e1000_eeprom_spi;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4502
        eeprom->opcode_bits = 8;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4503
        eeprom->delay_usec = 1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4504
        if (eecd & E1000_EECD_ADDR_BITS) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4505
            eeprom->page_size = 32;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4506
            eeprom->address_bits = 16;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4507
        } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4508
            eeprom->page_size = 8;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4509
            eeprom->address_bits = 8;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4510
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4511
        eeprom->use_eerd = true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4512
        eeprom->use_eewr = false;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4513
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4514
    case e1000_ich8lan:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4515
        {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4516
        s32  i = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4517
        u32 flash_size = E1000_READ_ICH_FLASH_REG(hw, ICH_FLASH_GFPREG);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4518
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4519
        eeprom->type = e1000_eeprom_ich8;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4520
        eeprom->use_eerd = false;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4521
        eeprom->use_eewr = false;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4522
        eeprom->word_size = E1000_SHADOW_RAM_WORDS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4523
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4524
        /* Zero the shadow RAM structure. But don't load it from NVM
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4525
         * so as to save time for driver init */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4526
        if (hw->eeprom_shadow_ram != NULL) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4527
            for (i = 0; i < E1000_SHADOW_RAM_WORDS; i++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4528
                hw->eeprom_shadow_ram[i].modified = false;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4529
                hw->eeprom_shadow_ram[i].eeprom_word = 0xFFFF;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4530
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4531
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4532
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4533
        hw->flash_base_addr = (flash_size & ICH_GFPREG_BASE_MASK) *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4534
                              ICH_FLASH_SECTOR_SIZE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4535
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4536
        hw->flash_bank_size = ((flash_size >> 16) & ICH_GFPREG_BASE_MASK) + 1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4537
        hw->flash_bank_size -= (flash_size & ICH_GFPREG_BASE_MASK);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4538
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4539
        hw->flash_bank_size *= ICH_FLASH_SECTOR_SIZE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4540
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4541
        hw->flash_bank_size /= 2 * sizeof(u16);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4542
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4543
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4544
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4545
    default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4546
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4547
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4548
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4549
    if (eeprom->type == e1000_eeprom_spi) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4550
        /* eeprom_size will be an enum [0..8] that maps to eeprom sizes 128B to
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4551
         * 32KB (incremented by powers of 2).
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4552
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4553
        if (hw->mac_type <= e1000_82547_rev_2) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4554
            /* Set to default value for initial eeprom read. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4555
            eeprom->word_size = 64;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4556
            ret_val = e1000_read_eeprom(hw, EEPROM_CFG, 1, &eeprom_size);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4557
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4558
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4559
            eeprom_size = (eeprom_size & EEPROM_SIZE_MASK) >> EEPROM_SIZE_SHIFT;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4560
            /* 256B eeprom size was not supported in earlier hardware, so we
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4561
             * bump eeprom_size up one to ensure that "1" (which maps to 256B)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4562
             * is never the result used in the shifting logic below. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4563
            if (eeprom_size)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4564
                eeprom_size++;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4565
        } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4566
            eeprom_size = (u16)((eecd & E1000_EECD_SIZE_EX_MASK) >>
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4567
                          E1000_EECD_SIZE_EX_SHIFT);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4568
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4569
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4570
        eeprom->word_size = 1 << (eeprom_size + EEPROM_WORD_SIZE_SHIFT);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4571
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4572
    return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4573
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4574
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4575
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4576
 * Raises the EEPROM's clock input.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4577
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4578
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4579
 * eecd - EECD's current value
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4580
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4581
static void e1000_raise_ee_clk(struct e1000_hw *hw, u32 *eecd)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4582
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4583
    /* Raise the clock input to the EEPROM (by setting the SK bit), and then
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4584
     * wait <delay> microseconds.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4585
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4586
    *eecd = *eecd | E1000_EECD_SK;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4587
    ew32(EECD, *eecd);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4588
    E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4589
    udelay(hw->eeprom.delay_usec);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4590
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4591
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4592
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4593
 * Lowers the EEPROM's clock input.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4594
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4595
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4596
 * eecd - EECD's current value
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4597
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4598
static void e1000_lower_ee_clk(struct e1000_hw *hw, u32 *eecd)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4599
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4600
    /* Lower the clock input to the EEPROM (by clearing the SK bit), and then
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4601
     * wait 50 microseconds.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4602
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4603
    *eecd = *eecd & ~E1000_EECD_SK;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4604
    ew32(EECD, *eecd);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4605
    E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4606
    udelay(hw->eeprom.delay_usec);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4607
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4608
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4609
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4610
 * Shift data bits out to the EEPROM.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4611
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4612
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4613
 * data - data to send to the EEPROM
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4614
 * count - number of bits to shift out
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4615
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4616
static void e1000_shift_out_ee_bits(struct e1000_hw *hw, u16 data, u16 count)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4617
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4618
    struct e1000_eeprom_info *eeprom = &hw->eeprom;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4619
    u32 eecd;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4620
    u32 mask;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4621
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4622
    /* We need to shift "count" bits out to the EEPROM. So, value in the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4623
     * "data" parameter will be shifted out to the EEPROM one bit at a time.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4624
     * In order to do this, "data" must be broken down into bits.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4625
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4626
    mask = 0x01 << (count - 1);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4627
    eecd = er32(EECD);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4628
    if (eeprom->type == e1000_eeprom_microwire) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4629
        eecd &= ~E1000_EECD_DO;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4630
    } else if (eeprom->type == e1000_eeprom_spi) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4631
        eecd |= E1000_EECD_DO;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4632
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4633
    do {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4634
        /* A "1" is shifted out to the EEPROM by setting bit "DI" to a "1",
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4635
         * and then raising and then lowering the clock (the SK bit controls
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4636
         * the clock input to the EEPROM).  A "0" is shifted out to the EEPROM
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4637
         * by setting "DI" to "0" and then raising and then lowering the clock.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4638
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4639
        eecd &= ~E1000_EECD_DI;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4640
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4641
        if (data & mask)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4642
            eecd |= E1000_EECD_DI;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4643
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4644
        ew32(EECD, eecd);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4645
        E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4646
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4647
        udelay(eeprom->delay_usec);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4648
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4649
        e1000_raise_ee_clk(hw, &eecd);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4650
        e1000_lower_ee_clk(hw, &eecd);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4651
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4652
        mask = mask >> 1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4653
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4654
    } while (mask);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4655
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4656
    /* We leave the "DI" bit set to "0" when we leave this routine. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4657
    eecd &= ~E1000_EECD_DI;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4658
    ew32(EECD, eecd);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4659
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4660
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4661
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4662
 * Shift data bits in from the EEPROM
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4663
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4664
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4665
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4666
static u16 e1000_shift_in_ee_bits(struct e1000_hw *hw, u16 count)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4667
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4668
    u32 eecd;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4669
    u32 i;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4670
    u16 data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4671
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4672
    /* In order to read a register from the EEPROM, we need to shift 'count'
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4673
     * bits in from the EEPROM. Bits are "shifted in" by raising the clock
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4674
     * input to the EEPROM (setting the SK bit), and then reading the value of
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4675
     * the "DO" bit.  During this "shifting in" process the "DI" bit should
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4676
     * always be clear.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4677
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4678
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4679
    eecd = er32(EECD);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4680
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4681
    eecd &= ~(E1000_EECD_DO | E1000_EECD_DI);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4682
    data = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4683
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4684
    for (i = 0; i < count; i++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4685
        data = data << 1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4686
        e1000_raise_ee_clk(hw, &eecd);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4687
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4688
        eecd = er32(EECD);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4689
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4690
        eecd &= ~(E1000_EECD_DI);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4691
        if (eecd & E1000_EECD_DO)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4692
            data |= 1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4693
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4694
        e1000_lower_ee_clk(hw, &eecd);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4695
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4696
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4697
    return data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4698
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4699
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4700
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4701
 * Prepares EEPROM for access
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4702
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4703
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4704
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4705
 * Lowers EEPROM clock. Clears input pin. Sets the chip select pin. This
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4706
 * function should be called before issuing a command to the EEPROM.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4707
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4708
static s32 e1000_acquire_eeprom(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4709
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4710
    struct e1000_eeprom_info *eeprom = &hw->eeprom;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4711
    u32 eecd, i=0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4712
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4713
    DEBUGFUNC("e1000_acquire_eeprom");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4714
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4715
    if (e1000_swfw_sync_acquire(hw, E1000_SWFW_EEP_SM))
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4716
        return -E1000_ERR_SWFW_SYNC;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4717
    eecd = er32(EECD);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4718
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4719
    if (hw->mac_type != e1000_82573) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4720
        /* Request EEPROM Access */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4721
        if (hw->mac_type > e1000_82544) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4722
            eecd |= E1000_EECD_REQ;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4723
            ew32(EECD, eecd);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4724
            eecd = er32(EECD);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4725
            while ((!(eecd & E1000_EECD_GNT)) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4726
                  (i < E1000_EEPROM_GRANT_ATTEMPTS)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4727
                i++;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4728
                udelay(5);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4729
                eecd = er32(EECD);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4730
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4731
            if (!(eecd & E1000_EECD_GNT)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4732
                eecd &= ~E1000_EECD_REQ;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4733
                ew32(EECD, eecd);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4734
                DEBUGOUT("Could not acquire EEPROM grant\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4735
                e1000_swfw_sync_release(hw, E1000_SWFW_EEP_SM);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4736
                return -E1000_ERR_EEPROM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4737
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4738
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4739
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4740
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4741
    /* Setup EEPROM for Read/Write */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4742
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4743
    if (eeprom->type == e1000_eeprom_microwire) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4744
        /* Clear SK and DI */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4745
        eecd &= ~(E1000_EECD_DI | E1000_EECD_SK);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4746
        ew32(EECD, eecd);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4747
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4748
        /* Set CS */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4749
        eecd |= E1000_EECD_CS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4750
        ew32(EECD, eecd);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4751
    } else if (eeprom->type == e1000_eeprom_spi) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4752
        /* Clear SK and CS */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4753
        eecd &= ~(E1000_EECD_CS | E1000_EECD_SK);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4754
        ew32(EECD, eecd);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4755
        udelay(1);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4756
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4757
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4758
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4759
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4760
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4761
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4762
 * Returns EEPROM to a "standby" state
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4763
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4764
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4765
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4766
static void e1000_standby_eeprom(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4767
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4768
    struct e1000_eeprom_info *eeprom = &hw->eeprom;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4769
    u32 eecd;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4770
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4771
    eecd = er32(EECD);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4772
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4773
    if (eeprom->type == e1000_eeprom_microwire) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4774
        eecd &= ~(E1000_EECD_CS | E1000_EECD_SK);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4775
        ew32(EECD, eecd);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4776
        E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4777
        udelay(eeprom->delay_usec);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4778
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4779
        /* Clock high */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4780
        eecd |= E1000_EECD_SK;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4781
        ew32(EECD, eecd);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4782
        E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4783
        udelay(eeprom->delay_usec);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4784
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4785
        /* Select EEPROM */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4786
        eecd |= E1000_EECD_CS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4787
        ew32(EECD, eecd);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4788
        E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4789
        udelay(eeprom->delay_usec);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4790
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4791
        /* Clock low */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4792
        eecd &= ~E1000_EECD_SK;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4793
        ew32(EECD, eecd);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4794
        E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4795
        udelay(eeprom->delay_usec);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4796
    } else if (eeprom->type == e1000_eeprom_spi) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4797
        /* Toggle CS to flush commands */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4798
        eecd |= E1000_EECD_CS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4799
        ew32(EECD, eecd);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4800
        E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4801
        udelay(eeprom->delay_usec);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4802
        eecd &= ~E1000_EECD_CS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4803
        ew32(EECD, eecd);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4804
        E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4805
        udelay(eeprom->delay_usec);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4806
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4807
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4808
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4809
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4810
 * Terminates a command by inverting the EEPROM's chip select pin
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4811
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4812
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4813
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4814
static void e1000_release_eeprom(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4815
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4816
    u32 eecd;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4817
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4818
    DEBUGFUNC("e1000_release_eeprom");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4819
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4820
    eecd = er32(EECD);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4821
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4822
    if (hw->eeprom.type == e1000_eeprom_spi) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4823
        eecd |= E1000_EECD_CS;  /* Pull CS high */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4824
        eecd &= ~E1000_EECD_SK; /* Lower SCK */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4825
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4826
        ew32(EECD, eecd);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4827
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4828
        udelay(hw->eeprom.delay_usec);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4829
    } else if (hw->eeprom.type == e1000_eeprom_microwire) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4830
        /* cleanup eeprom */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4831
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4832
        /* CS on Microwire is active-high */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4833
        eecd &= ~(E1000_EECD_CS | E1000_EECD_DI);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4834
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4835
        ew32(EECD, eecd);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4836
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4837
        /* Rising edge of clock */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4838
        eecd |= E1000_EECD_SK;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4839
        ew32(EECD, eecd);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4840
        E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4841
        udelay(hw->eeprom.delay_usec);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4842
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4843
        /* Falling edge of clock */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4844
        eecd &= ~E1000_EECD_SK;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4845
        ew32(EECD, eecd);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4846
        E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4847
        udelay(hw->eeprom.delay_usec);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4848
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4849
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4850
    /* Stop requesting EEPROM access */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4851
    if (hw->mac_type > e1000_82544) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4852
        eecd &= ~E1000_EECD_REQ;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4853
        ew32(EECD, eecd);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4854
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4855
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4856
    e1000_swfw_sync_release(hw, E1000_SWFW_EEP_SM);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4857
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4858
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4859
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4860
 * Reads a 16 bit word from the EEPROM.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4861
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4862
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4863
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4864
static s32 e1000_spi_eeprom_ready(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4865
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4866
    u16 retry_count = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4867
    u8 spi_stat_reg;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4868
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4869
    DEBUGFUNC("e1000_spi_eeprom_ready");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4870
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4871
    /* Read "Status Register" repeatedly until the LSB is cleared.  The
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4872
     * EEPROM will signal that the command has been completed by clearing
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4873
     * bit 0 of the internal status register.  If it's not cleared within
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4874
     * 5 milliseconds, then error out.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4875
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4876
    retry_count = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4877
    do {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4878
        e1000_shift_out_ee_bits(hw, EEPROM_RDSR_OPCODE_SPI,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4879
                                hw->eeprom.opcode_bits);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4880
        spi_stat_reg = (u8)e1000_shift_in_ee_bits(hw, 8);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4881
        if (!(spi_stat_reg & EEPROM_STATUS_RDY_SPI))
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4882
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4883
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4884
        udelay(5);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4885
        retry_count += 5;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4886
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4887
        e1000_standby_eeprom(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4888
    } while (retry_count < EEPROM_MAX_RETRY_SPI);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4889
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4890
    /* ATMEL SPI write time could vary from 0-20mSec on 3.3V devices (and
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4891
     * only 0-5mSec on 5V devices)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4892
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4893
    if (retry_count >= EEPROM_MAX_RETRY_SPI) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4894
        DEBUGOUT("SPI EEPROM Status error\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4895
        return -E1000_ERR_EEPROM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4896
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4897
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4898
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4899
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4900
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4901
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4902
 * Reads a 16 bit word from the EEPROM.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4903
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4904
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4905
 * offset - offset of  word in the EEPROM to read
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4906
 * data - word read from the EEPROM
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4907
 * words - number of words to read
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4908
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4909
s32 e1000_read_eeprom(struct e1000_hw *hw, u16 offset, u16 words, u16 *data)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4910
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4911
    s32 ret;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4912
    spin_lock(&e1000_eeprom_lock);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4913
    ret = e1000_do_read_eeprom(hw, offset, words, data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4914
    spin_unlock(&e1000_eeprom_lock);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4915
    return ret;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4916
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4917
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4918
static s32 e1000_do_read_eeprom(struct e1000_hw *hw, u16 offset, u16 words, u16 *data)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4919
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4920
    struct e1000_eeprom_info *eeprom = &hw->eeprom;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4921
    u32 i = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4922
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4923
    DEBUGFUNC("e1000_read_eeprom");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4924
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4925
    /* If eeprom is not yet detected, do so now */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4926
    if (eeprom->word_size == 0)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4927
        e1000_init_eeprom_params(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4928
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4929
    /* A check for invalid values:  offset too large, too many words, and not
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4930
     * enough words.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4931
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4932
    if ((offset >= eeprom->word_size) || (words > eeprom->word_size - offset) ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4933
       (words == 0)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4934
        DEBUGOUT2("\"words\" parameter out of bounds. Words = %d, size = %d\n", offset, eeprom->word_size);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4935
        return -E1000_ERR_EEPROM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4936
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4937
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4938
    /* EEPROM's that don't use EERD to read require us to bit-bang the SPI
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4939
     * directly. In this case, we need to acquire the EEPROM so that
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4940
     * FW or other port software does not interrupt.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4941
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4942
    if (e1000_is_onboard_nvm_eeprom(hw) && !hw->eeprom.use_eerd) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4943
        /* Prepare the EEPROM for bit-bang reading */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4944
        if (e1000_acquire_eeprom(hw) != E1000_SUCCESS)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4945
            return -E1000_ERR_EEPROM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4946
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4947
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4948
    /* Eerd register EEPROM access requires no eeprom aquire/release */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4949
    if (eeprom->use_eerd)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4950
        return e1000_read_eeprom_eerd(hw, offset, words, data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4951
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4952
    /* ICH EEPROM access is done via the ICH flash controller */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4953
    if (eeprom->type == e1000_eeprom_ich8)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4954
        return e1000_read_eeprom_ich8(hw, offset, words, data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4955
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4956
    /* Set up the SPI or Microwire EEPROM for bit-bang reading.  We have
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4957
     * acquired the EEPROM at this point, so any returns should relase it */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4958
    if (eeprom->type == e1000_eeprom_spi) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4959
        u16 word_in;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4960
        u8 read_opcode = EEPROM_READ_OPCODE_SPI;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4961
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4962
        if (e1000_spi_eeprom_ready(hw)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4963
            e1000_release_eeprom(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4964
            return -E1000_ERR_EEPROM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4965
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4966
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4967
        e1000_standby_eeprom(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4968
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4969
        /* Some SPI eeproms use the 8th address bit embedded in the opcode */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4970
        if ((eeprom->address_bits == 8) && (offset >= 128))
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4971
            read_opcode |= EEPROM_A8_OPCODE_SPI;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4972
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4973
        /* Send the READ command (opcode + addr)  */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4974
        e1000_shift_out_ee_bits(hw, read_opcode, eeprom->opcode_bits);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4975
        e1000_shift_out_ee_bits(hw, (u16)(offset*2), eeprom->address_bits);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4976
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4977
        /* Read the data.  The address of the eeprom internally increments with
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4978
         * each byte (spi) being read, saving on the overhead of eeprom setup
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4979
         * and tear-down.  The address counter will roll over if reading beyond
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4980
         * the size of the eeprom, thus allowing the entire memory to be read
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4981
         * starting from any offset. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4982
        for (i = 0; i < words; i++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4983
            word_in = e1000_shift_in_ee_bits(hw, 16);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4984
            data[i] = (word_in >> 8) | (word_in << 8);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4985
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4986
    } else if (eeprom->type == e1000_eeprom_microwire) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4987
        for (i = 0; i < words; i++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4988
            /* Send the READ command (opcode + addr)  */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4989
            e1000_shift_out_ee_bits(hw, EEPROM_READ_OPCODE_MICROWIRE,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4990
                                    eeprom->opcode_bits);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4991
            e1000_shift_out_ee_bits(hw, (u16)(offset + i),
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4992
                                    eeprom->address_bits);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4993
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4994
            /* Read the data.  For microwire, each word requires the overhead
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4995
             * of eeprom setup and tear-down. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4996
            data[i] = e1000_shift_in_ee_bits(hw, 16);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4997
            e1000_standby_eeprom(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4998
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  4999
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5000
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5001
    /* End this read operation */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5002
    e1000_release_eeprom(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5003
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5004
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5005
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5006
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5007
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5008
 * Reads a 16 bit word from the EEPROM using the EERD register.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5009
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5010
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5011
 * offset - offset of  word in the EEPROM to read
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5012
 * data - word read from the EEPROM
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5013
 * words - number of words to read
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5014
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5015
static s32 e1000_read_eeprom_eerd(struct e1000_hw *hw, u16 offset, u16 words,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5016
				  u16 *data)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5017
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5018
    u32 i, eerd = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5019
    s32 error = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5020
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5021
    for (i = 0; i < words; i++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5022
        eerd = ((offset+i) << E1000_EEPROM_RW_ADDR_SHIFT) +
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5023
                         E1000_EEPROM_RW_REG_START;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5024
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5025
        ew32(EERD, eerd);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5026
        error = e1000_poll_eerd_eewr_done(hw, E1000_EEPROM_POLL_READ);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5027
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5028
        if (error) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5029
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5030
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5031
        data[i] = (er32(EERD) >> E1000_EEPROM_RW_REG_DATA);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5032
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5033
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5034
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5035
    return error;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5036
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5037
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5038
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5039
 * Writes a 16 bit word from the EEPROM using the EEWR register.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5040
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5041
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5042
 * offset - offset of  word in the EEPROM to read
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5043
 * data - word read from the EEPROM
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5044
 * words - number of words to read
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5045
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5046
static s32 e1000_write_eeprom_eewr(struct e1000_hw *hw, u16 offset, u16 words,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5047
				   u16 *data)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5048
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5049
    u32    register_value = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5050
    u32    i              = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5051
    s32     error          = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5052
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5053
    if (e1000_swfw_sync_acquire(hw, E1000_SWFW_EEP_SM))
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5054
        return -E1000_ERR_SWFW_SYNC;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5055
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5056
    for (i = 0; i < words; i++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5057
        register_value = (data[i] << E1000_EEPROM_RW_REG_DATA) |
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5058
                         ((offset+i) << E1000_EEPROM_RW_ADDR_SHIFT) |
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5059
                         E1000_EEPROM_RW_REG_START;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5060
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5061
        error = e1000_poll_eerd_eewr_done(hw, E1000_EEPROM_POLL_WRITE);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5062
        if (error) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5063
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5064
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5065
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5066
        ew32(EEWR, register_value);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5067
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5068
        error = e1000_poll_eerd_eewr_done(hw, E1000_EEPROM_POLL_WRITE);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5069
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5070
        if (error) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5071
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5072
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5073
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5074
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5075
    e1000_swfw_sync_release(hw, E1000_SWFW_EEP_SM);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5076
    return error;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5077
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5078
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5079
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5080
 * Polls the status bit (bit 1) of the EERD to determine when the read is done.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5081
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5082
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5083
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5084
static s32 e1000_poll_eerd_eewr_done(struct e1000_hw *hw, int eerd)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5085
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5086
    u32 attempts = 100000;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5087
    u32 i, reg = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5088
    s32 done = E1000_ERR_EEPROM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5089
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5090
    for (i = 0; i < attempts; i++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5091
        if (eerd == E1000_EEPROM_POLL_READ)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5092
            reg = er32(EERD);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5093
        else
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5094
            reg = er32(EEWR);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5095
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5096
        if (reg & E1000_EEPROM_RW_REG_DONE) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5097
            done = E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5098
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5099
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5100
        udelay(5);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5101
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5102
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5103
    return done;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5104
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5105
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5106
/***************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5107
* Description:     Determines if the onboard NVM is FLASH or EEPROM.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5108
*
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5109
* hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5110
****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5111
static bool e1000_is_onboard_nvm_eeprom(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5112
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5113
    u32 eecd = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5114
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5115
    DEBUGFUNC("e1000_is_onboard_nvm_eeprom");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5116
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5117
    if (hw->mac_type == e1000_ich8lan)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5118
        return false;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5119
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5120
    if (hw->mac_type == e1000_82573) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5121
        eecd = er32(EECD);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5122
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5123
        /* Isolate bits 15 & 16 */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5124
        eecd = ((eecd >> 15) & 0x03);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5125
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5126
        /* If both bits are set, device is Flash type */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5127
        if (eecd == 0x03) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5128
            return false;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5129
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5130
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5131
    return true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5132
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5133
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5134
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5135
 * Verifies that the EEPROM has a valid checksum
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5136
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5137
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5138
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5139
 * Reads the first 64 16 bit words of the EEPROM and sums the values read.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5140
 * If the the sum of the 64 16 bit words is 0xBABA, the EEPROM's checksum is
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5141
 * valid.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5142
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5143
s32 e1000_validate_eeprom_checksum(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5144
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5145
    u16 checksum = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5146
    u16 i, eeprom_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5147
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5148
    DEBUGFUNC("e1000_validate_eeprom_checksum");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5149
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5150
    if ((hw->mac_type == e1000_82573) && !e1000_is_onboard_nvm_eeprom(hw)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5151
        /* Check bit 4 of word 10h.  If it is 0, firmware is done updating
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5152
         * 10h-12h.  Checksum may need to be fixed. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5153
        e1000_read_eeprom(hw, 0x10, 1, &eeprom_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5154
        if ((eeprom_data & 0x10) == 0) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5155
            /* Read 0x23 and check bit 15.  This bit is a 1 when the checksum
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5156
             * has already been fixed.  If the checksum is still wrong and this
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5157
             * bit is a 1, we need to return bad checksum.  Otherwise, we need
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5158
             * to set this bit to a 1 and update the checksum. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5159
            e1000_read_eeprom(hw, 0x23, 1, &eeprom_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5160
            if ((eeprom_data & 0x8000) == 0) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5161
                eeprom_data |= 0x8000;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5162
                e1000_write_eeprom(hw, 0x23, 1, &eeprom_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5163
                e1000_update_eeprom_checksum(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5164
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5165
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5166
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5167
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5168
    if (hw->mac_type == e1000_ich8lan) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5169
        /* Drivers must allocate the shadow ram structure for the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5170
         * EEPROM checksum to be updated.  Otherwise, this bit as well
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5171
         * as the checksum must both be set correctly for this
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5172
         * validation to pass.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5173
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5174
        e1000_read_eeprom(hw, 0x19, 1, &eeprom_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5175
        if ((eeprom_data & 0x40) == 0) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5176
            eeprom_data |= 0x40;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5177
            e1000_write_eeprom(hw, 0x19, 1, &eeprom_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5178
            e1000_update_eeprom_checksum(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5179
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5180
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5181
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5182
    for (i = 0; i < (EEPROM_CHECKSUM_REG + 1); i++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5183
        if (e1000_read_eeprom(hw, i, 1, &eeprom_data) < 0) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5184
            DEBUGOUT("EEPROM Read Error\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5185
            return -E1000_ERR_EEPROM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5186
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5187
        checksum += eeprom_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5188
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5189
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5190
    if (checksum == (u16)EEPROM_SUM)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5191
        return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5192
    else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5193
        DEBUGOUT("EEPROM Checksum Invalid\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5194
        return -E1000_ERR_EEPROM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5195
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5196
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5197
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5198
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5199
 * Calculates the EEPROM checksum and writes it to the EEPROM
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5200
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5201
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5202
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5203
 * Sums the first 63 16 bit words of the EEPROM. Subtracts the sum from 0xBABA.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5204
 * Writes the difference to word offset 63 of the EEPROM.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5205
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5206
s32 e1000_update_eeprom_checksum(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5207
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5208
    u32 ctrl_ext;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5209
    u16 checksum = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5210
    u16 i, eeprom_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5211
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5212
    DEBUGFUNC("e1000_update_eeprom_checksum");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5213
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5214
    for (i = 0; i < EEPROM_CHECKSUM_REG; i++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5215
        if (e1000_read_eeprom(hw, i, 1, &eeprom_data) < 0) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5216
            DEBUGOUT("EEPROM Read Error\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5217
            return -E1000_ERR_EEPROM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5218
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5219
        checksum += eeprom_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5220
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5221
    checksum = (u16)EEPROM_SUM - checksum;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5222
    if (e1000_write_eeprom(hw, EEPROM_CHECKSUM_REG, 1, &checksum) < 0) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5223
        DEBUGOUT("EEPROM Write Error\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5224
        return -E1000_ERR_EEPROM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5225
    } else if (hw->eeprom.type == e1000_eeprom_flash) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5226
        e1000_commit_shadow_ram(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5227
    } else if (hw->eeprom.type == e1000_eeprom_ich8) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5228
        e1000_commit_shadow_ram(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5229
        /* Reload the EEPROM, or else modifications will not appear
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5230
         * until after next adapter reset. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5231
        ctrl_ext = er32(CTRL_EXT);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5232
        ctrl_ext |= E1000_CTRL_EXT_EE_RST;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5233
        ew32(CTRL_EXT, ctrl_ext);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5234
        msleep(10);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5235
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5236
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5237
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5238
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5239
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5240
 * Parent function for writing words to the different EEPROM types.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5241
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5242
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5243
 * offset - offset within the EEPROM to be written to
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5244
 * words - number of words to write
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5245
 * data - 16 bit word to be written to the EEPROM
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5246
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5247
 * If e1000_update_eeprom_checksum is not called after this function, the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5248
 * EEPROM will most likely contain an invalid checksum.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5249
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5250
s32 e1000_write_eeprom(struct e1000_hw *hw, u16 offset, u16 words, u16 *data)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5251
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5252
    s32 ret;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5253
    spin_lock(&e1000_eeprom_lock);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5254
    ret = e1000_do_write_eeprom(hw, offset, words, data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5255
    spin_unlock(&e1000_eeprom_lock);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5256
    return ret;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5257
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5258
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5259
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5260
static s32 e1000_do_write_eeprom(struct e1000_hw *hw, u16 offset, u16 words, u16 *data)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5261
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5262
    struct e1000_eeprom_info *eeprom = &hw->eeprom;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5263
    s32 status = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5264
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5265
    DEBUGFUNC("e1000_write_eeprom");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5266
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5267
    /* If eeprom is not yet detected, do so now */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5268
    if (eeprom->word_size == 0)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5269
        e1000_init_eeprom_params(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5270
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5271
    /* A check for invalid values:  offset too large, too many words, and not
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5272
     * enough words.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5273
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5274
    if ((offset >= eeprom->word_size) || (words > eeprom->word_size - offset) ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5275
       (words == 0)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5276
        DEBUGOUT("\"words\" parameter out of bounds\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5277
        return -E1000_ERR_EEPROM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5278
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5279
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5280
    /* 82573 writes only through eewr */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5281
    if (eeprom->use_eewr)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5282
        return e1000_write_eeprom_eewr(hw, offset, words, data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5283
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5284
    if (eeprom->type == e1000_eeprom_ich8)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5285
        return e1000_write_eeprom_ich8(hw, offset, words, data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5286
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5287
    /* Prepare the EEPROM for writing  */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5288
    if (e1000_acquire_eeprom(hw) != E1000_SUCCESS)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5289
        return -E1000_ERR_EEPROM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5290
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5291
    if (eeprom->type == e1000_eeprom_microwire) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5292
        status = e1000_write_eeprom_microwire(hw, offset, words, data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5293
    } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5294
        status = e1000_write_eeprom_spi(hw, offset, words, data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5295
        msleep(10);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5296
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5297
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5298
    /* Done with writing */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5299
    e1000_release_eeprom(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5300
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5301
    return status;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5302
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5303
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5304
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5305
 * Writes a 16 bit word to a given offset in an SPI EEPROM.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5306
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5307
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5308
 * offset - offset within the EEPROM to be written to
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5309
 * words - number of words to write
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5310
 * data - pointer to array of 8 bit words to be written to the EEPROM
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5311
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5312
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5313
static s32 e1000_write_eeprom_spi(struct e1000_hw *hw, u16 offset, u16 words,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5314
				  u16 *data)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5315
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5316
    struct e1000_eeprom_info *eeprom = &hw->eeprom;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5317
    u16 widx = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5318
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5319
    DEBUGFUNC("e1000_write_eeprom_spi");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5320
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5321
    while (widx < words) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5322
        u8 write_opcode = EEPROM_WRITE_OPCODE_SPI;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5323
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5324
        if (e1000_spi_eeprom_ready(hw)) return -E1000_ERR_EEPROM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5325
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5326
        e1000_standby_eeprom(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5327
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5328
        /*  Send the WRITE ENABLE command (8 bit opcode )  */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5329
        e1000_shift_out_ee_bits(hw, EEPROM_WREN_OPCODE_SPI,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5330
                                    eeprom->opcode_bits);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5331
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5332
        e1000_standby_eeprom(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5333
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5334
        /* Some SPI eeproms use the 8th address bit embedded in the opcode */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5335
        if ((eeprom->address_bits == 8) && (offset >= 128))
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5336
            write_opcode |= EEPROM_A8_OPCODE_SPI;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5337
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5338
        /* Send the Write command (8-bit opcode + addr) */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5339
        e1000_shift_out_ee_bits(hw, write_opcode, eeprom->opcode_bits);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5340
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5341
        e1000_shift_out_ee_bits(hw, (u16)((offset + widx)*2),
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5342
                                eeprom->address_bits);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5343
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5344
        /* Send the data */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5345
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5346
        /* Loop to allow for up to whole page write (32 bytes) of eeprom */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5347
        while (widx < words) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5348
            u16 word_out = data[widx];
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5349
            word_out = (word_out >> 8) | (word_out << 8);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5350
            e1000_shift_out_ee_bits(hw, word_out, 16);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5351
            widx++;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5352
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5353
            /* Some larger eeprom sizes are capable of a 32-byte PAGE WRITE
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5354
             * operation, while the smaller eeproms are capable of an 8-byte
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5355
             * PAGE WRITE operation.  Break the inner loop to pass new address
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5356
             */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5357
            if ((((offset + widx)*2) % eeprom->page_size) == 0) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5358
                e1000_standby_eeprom(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5359
                break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5360
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5361
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5362
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5363
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5364
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5365
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5366
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5367
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5368
 * Writes a 16 bit word to a given offset in a Microwire EEPROM.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5369
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5370
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5371
 * offset - offset within the EEPROM to be written to
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5372
 * words - number of words to write
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5373
 * data - pointer to array of 16 bit words to be written to the EEPROM
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5374
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5375
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5376
static s32 e1000_write_eeprom_microwire(struct e1000_hw *hw, u16 offset,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5377
					u16 words, u16 *data)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5378
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5379
    struct e1000_eeprom_info *eeprom = &hw->eeprom;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5380
    u32 eecd;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5381
    u16 words_written = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5382
    u16 i = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5383
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5384
    DEBUGFUNC("e1000_write_eeprom_microwire");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5385
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5386
    /* Send the write enable command to the EEPROM (3-bit opcode plus
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5387
     * 6/8-bit dummy address beginning with 11).  It's less work to include
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5388
     * the 11 of the dummy address as part of the opcode than it is to shift
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5389
     * it over the correct number of bits for the address.  This puts the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5390
     * EEPROM into write/erase mode.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5391
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5392
    e1000_shift_out_ee_bits(hw, EEPROM_EWEN_OPCODE_MICROWIRE,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5393
                            (u16)(eeprom->opcode_bits + 2));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5394
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5395
    e1000_shift_out_ee_bits(hw, 0, (u16)(eeprom->address_bits - 2));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5396
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5397
    /* Prepare the EEPROM */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5398
    e1000_standby_eeprom(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5399
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5400
    while (words_written < words) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5401
        /* Send the Write command (3-bit opcode + addr) */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5402
        e1000_shift_out_ee_bits(hw, EEPROM_WRITE_OPCODE_MICROWIRE,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5403
                                eeprom->opcode_bits);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5404
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5405
        e1000_shift_out_ee_bits(hw, (u16)(offset + words_written),
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5406
                                eeprom->address_bits);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5407
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5408
        /* Send the data */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5409
        e1000_shift_out_ee_bits(hw, data[words_written], 16);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5410
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5411
        /* Toggle the CS line.  This in effect tells the EEPROM to execute
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5412
         * the previous command.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5413
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5414
        e1000_standby_eeprom(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5415
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5416
        /* Read DO repeatedly until it is high (equal to '1').  The EEPROM will
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5417
         * signal that the command has been completed by raising the DO signal.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5418
         * If DO does not go high in 10 milliseconds, then error out.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5419
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5420
        for (i = 0; i < 200; i++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5421
            eecd = er32(EECD);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5422
            if (eecd & E1000_EECD_DO) break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5423
            udelay(50);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5424
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5425
        if (i == 200) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5426
            DEBUGOUT("EEPROM Write did not complete\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5427
            return -E1000_ERR_EEPROM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5428
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5429
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5430
        /* Recover from write */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5431
        e1000_standby_eeprom(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5432
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5433
        words_written++;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5434
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5435
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5436
    /* Send the write disable command to the EEPROM (3-bit opcode plus
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5437
     * 6/8-bit dummy address beginning with 10).  It's less work to include
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5438
     * the 10 of the dummy address as part of the opcode than it is to shift
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5439
     * it over the correct number of bits for the address.  This takes the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5440
     * EEPROM out of write/erase mode.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5441
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5442
    e1000_shift_out_ee_bits(hw, EEPROM_EWDS_OPCODE_MICROWIRE,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5443
                            (u16)(eeprom->opcode_bits + 2));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5444
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5445
    e1000_shift_out_ee_bits(hw, 0, (u16)(eeprom->address_bits - 2));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5446
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5447
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5448
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5449
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5450
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5451
 * Flushes the cached eeprom to NVM. This is done by saving the modified values
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5452
 * in the eeprom cache and the non modified values in the currently active bank
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5453
 * to the new bank.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5454
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5455
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5456
 * offset - offset of  word in the EEPROM to read
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5457
 * data - word read from the EEPROM
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5458
 * words - number of words to read
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5459
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5460
static s32 e1000_commit_shadow_ram(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5461
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5462
    u32 attempts = 100000;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5463
    u32 eecd = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5464
    u32 flop = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5465
    u32 i = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5466
    s32 error = E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5467
    u32 old_bank_offset = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5468
    u32 new_bank_offset = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5469
    u8 low_byte = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5470
    u8 high_byte = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5471
    bool sector_write_failed = false;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5472
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5473
    if (hw->mac_type == e1000_82573) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5474
        /* The flop register will be used to determine if flash type is STM */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5475
        flop = er32(FLOP);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5476
        for (i=0; i < attempts; i++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5477
            eecd = er32(EECD);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5478
            if ((eecd & E1000_EECD_FLUPD) == 0) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5479
                break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5480
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5481
            udelay(5);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5482
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5483
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5484
        if (i == attempts) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5485
            return -E1000_ERR_EEPROM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5486
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5487
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5488
        /* If STM opcode located in bits 15:8 of flop, reset firmware */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5489
        if ((flop & 0xFF00) == E1000_STM_OPCODE) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5490
            ew32(HICR, E1000_HICR_FW_RESET);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5491
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5492
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5493
        /* Perform the flash update */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5494
        ew32(EECD, eecd | E1000_EECD_FLUPD);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5495
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5496
        for (i=0; i < attempts; i++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5497
            eecd = er32(EECD);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5498
            if ((eecd & E1000_EECD_FLUPD) == 0) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5499
                break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5500
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5501
            udelay(5);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5502
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5503
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5504
        if (i == attempts) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5505
            return -E1000_ERR_EEPROM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5506
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5507
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5508
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5509
    if (hw->mac_type == e1000_ich8lan && hw->eeprom_shadow_ram != NULL) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5510
        /* We're writing to the opposite bank so if we're on bank 1,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5511
         * write to bank 0 etc.  We also need to erase the segment that
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5512
         * is going to be written */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5513
        if (!(er32(EECD) & E1000_EECD_SEC1VAL)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5514
            new_bank_offset = hw->flash_bank_size * 2;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5515
            old_bank_offset = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5516
            e1000_erase_ich8_4k_segment(hw, 1);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5517
        } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5518
            old_bank_offset = hw->flash_bank_size * 2;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5519
            new_bank_offset = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5520
            e1000_erase_ich8_4k_segment(hw, 0);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5521
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5522
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5523
        sector_write_failed = false;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5524
        /* Loop for every byte in the shadow RAM,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5525
         * which is in units of words. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5526
        for (i = 0; i < E1000_SHADOW_RAM_WORDS; i++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5527
            /* Determine whether to write the value stored
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5528
             * in the other NVM bank or a modified value stored
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5529
             * in the shadow RAM */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5530
            if (hw->eeprom_shadow_ram[i].modified) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5531
                low_byte = (u8)hw->eeprom_shadow_ram[i].eeprom_word;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5532
                udelay(100);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5533
                error = e1000_verify_write_ich8_byte(hw,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5534
                            (i << 1) + new_bank_offset, low_byte);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5535
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5536
                if (error != E1000_SUCCESS)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5537
                    sector_write_failed = true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5538
                else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5539
                    high_byte =
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5540
                        (u8)(hw->eeprom_shadow_ram[i].eeprom_word >> 8);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5541
                    udelay(100);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5542
                }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5543
            } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5544
                e1000_read_ich8_byte(hw, (i << 1) + old_bank_offset,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5545
                                     &low_byte);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5546
                udelay(100);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5547
                error = e1000_verify_write_ich8_byte(hw,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5548
                            (i << 1) + new_bank_offset, low_byte);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5549
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5550
                if (error != E1000_SUCCESS)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5551
                    sector_write_failed = true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5552
                else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5553
                    e1000_read_ich8_byte(hw, (i << 1) + old_bank_offset + 1,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5554
                                         &high_byte);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5555
                    udelay(100);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5556
                }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5557
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5558
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5559
            /* If the write of the low byte was successful, go ahead and
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5560
             * write the high byte while checking to make sure that if it
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5561
             * is the signature byte, then it is handled properly */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5562
            if (!sector_write_failed) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5563
                /* If the word is 0x13, then make sure the signature bits
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5564
                 * (15:14) are 11b until the commit has completed.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5565
                 * This will allow us to write 10b which indicates the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5566
                 * signature is valid.  We want to do this after the write
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5567
                 * has completed so that we don't mark the segment valid
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5568
                 * while the write is still in progress */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5569
                if (i == E1000_ICH_NVM_SIG_WORD)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5570
                    high_byte = E1000_ICH_NVM_SIG_MASK | high_byte;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5571
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5572
                error = e1000_verify_write_ich8_byte(hw,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5573
                            (i << 1) + new_bank_offset + 1, high_byte);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5574
                if (error != E1000_SUCCESS)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5575
                    sector_write_failed = true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5576
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5577
            } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5578
                /* If the write failed then break from the loop and
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5579
                 * return an error */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5580
                break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5581
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5582
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5583
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5584
        /* Don't bother writing the segment valid bits if sector
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5585
         * programming failed. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5586
        if (!sector_write_failed) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5587
            /* Finally validate the new segment by setting bit 15:14
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5588
             * to 10b in word 0x13 , this can be done without an
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5589
             * erase as well since these bits are 11 to start with
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5590
             * and we need to change bit 14 to 0b */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5591
            e1000_read_ich8_byte(hw,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5592
                                 E1000_ICH_NVM_SIG_WORD * 2 + 1 + new_bank_offset,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5593
                                 &high_byte);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5594
            high_byte &= 0xBF;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5595
            error = e1000_verify_write_ich8_byte(hw,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5596
                        E1000_ICH_NVM_SIG_WORD * 2 + 1 + new_bank_offset, high_byte);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5597
            /* And invalidate the previously valid segment by setting
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5598
             * its signature word (0x13) high_byte to 0b. This can be
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5599
             * done without an erase because flash erase sets all bits
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5600
             * to 1's. We can write 1's to 0's without an erase */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5601
            if (error == E1000_SUCCESS) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5602
                error = e1000_verify_write_ich8_byte(hw,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5603
                            E1000_ICH_NVM_SIG_WORD * 2 + 1 + old_bank_offset, 0);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5604
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5605
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5606
            /* Clear the now not used entry in the cache */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5607
            for (i = 0; i < E1000_SHADOW_RAM_WORDS; i++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5608
                hw->eeprom_shadow_ram[i].modified = false;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5609
                hw->eeprom_shadow_ram[i].eeprom_word = 0xFFFF;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5610
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5611
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5612
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5613
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5614
    return error;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5615
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5616
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5617
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5618
 * Reads the adapter's MAC address from the EEPROM and inverts the LSB for the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5619
 * second function of dual function devices
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5620
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5621
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5622
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5623
s32 e1000_read_mac_addr(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5624
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5625
    u16 offset;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5626
    u16 eeprom_data, i;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5627
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5628
    DEBUGFUNC("e1000_read_mac_addr");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5629
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5630
    for (i = 0; i < NODE_ADDRESS_SIZE; i += 2) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5631
        offset = i >> 1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5632
        if (e1000_read_eeprom(hw, offset, 1, &eeprom_data) < 0) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5633
            DEBUGOUT("EEPROM Read Error\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5634
            return -E1000_ERR_EEPROM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5635
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5636
        hw->perm_mac_addr[i] = (u8)(eeprom_data & 0x00FF);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5637
        hw->perm_mac_addr[i+1] = (u8)(eeprom_data >> 8);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5638
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5639
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5640
    switch (hw->mac_type) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5641
    default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5642
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5643
    case e1000_82546:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5644
    case e1000_82546_rev_3:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5645
    case e1000_82571:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5646
    case e1000_80003es2lan:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5647
        if (er32(STATUS) & E1000_STATUS_FUNC_1)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5648
            hw->perm_mac_addr[5] ^= 0x01;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5649
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5650
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5651
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5652
    for (i = 0; i < NODE_ADDRESS_SIZE; i++)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5653
        hw->mac_addr[i] = hw->perm_mac_addr[i];
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5654
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5655
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5656
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5657
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5658
 * Initializes receive address filters.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5659
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5660
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5661
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5662
 * Places the MAC address in receive address register 0 and clears the rest
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5663
 * of the receive addresss registers. Clears the multicast table. Assumes
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5664
 * the receiver is in reset when the routine is called.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5665
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5666
static void e1000_init_rx_addrs(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5667
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5668
    u32 i;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5669
    u32 rar_num;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5670
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5671
    DEBUGFUNC("e1000_init_rx_addrs");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5672
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5673
    /* Setup the receive address. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5674
    DEBUGOUT("Programming MAC Address into RAR[0]\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5675
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5676
    e1000_rar_set(hw, hw->mac_addr, 0);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5677
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5678
    rar_num = E1000_RAR_ENTRIES;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5679
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5680
    /* Reserve a spot for the Locally Administered Address to work around
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5681
     * an 82571 issue in which a reset on one port will reload the MAC on
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5682
     * the other port. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5683
    if ((hw->mac_type == e1000_82571) && (hw->laa_is_present))
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5684
        rar_num -= 1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5685
    if (hw->mac_type == e1000_ich8lan)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5686
        rar_num = E1000_RAR_ENTRIES_ICH8LAN;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5687
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5688
    /* Zero out the other 15 receive addresses. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5689
    DEBUGOUT("Clearing RAR[1-15]\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5690
    for (i = 1; i < rar_num; i++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5691
        E1000_WRITE_REG_ARRAY(hw, RA, (i << 1), 0);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5692
        E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5693
        E1000_WRITE_REG_ARRAY(hw, RA, ((i << 1) + 1), 0);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5694
        E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5695
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5696
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5697
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5698
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5699
 * Hashes an address to determine its location in the multicast table
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5700
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5701
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5702
 * mc_addr - the multicast address to hash
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5703
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5704
u32 e1000_hash_mc_addr(struct e1000_hw *hw, u8 *mc_addr)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5705
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5706
    u32 hash_value = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5707
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5708
    /* The portion of the address that is used for the hash table is
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5709
     * determined by the mc_filter_type setting.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5710
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5711
    switch (hw->mc_filter_type) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5712
    /* [0] [1] [2] [3] [4] [5]
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5713
     * 01  AA  00  12  34  56
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5714
     * LSB                 MSB
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5715
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5716
    case 0:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5717
        if (hw->mac_type == e1000_ich8lan) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5718
            /* [47:38] i.e. 0x158 for above example address */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5719
            hash_value = ((mc_addr[4] >> 6) | (((u16)mc_addr[5]) << 2));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5720
        } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5721
            /* [47:36] i.e. 0x563 for above example address */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5722
            hash_value = ((mc_addr[4] >> 4) | (((u16)mc_addr[5]) << 4));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5723
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5724
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5725
    case 1:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5726
        if (hw->mac_type == e1000_ich8lan) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5727
            /* [46:37] i.e. 0x2B1 for above example address */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5728
            hash_value = ((mc_addr[4] >> 5) | (((u16)mc_addr[5]) << 3));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5729
        } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5730
            /* [46:35] i.e. 0xAC6 for above example address */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5731
            hash_value = ((mc_addr[4] >> 3) | (((u16)mc_addr[5]) << 5));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5732
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5733
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5734
    case 2:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5735
        if (hw->mac_type == e1000_ich8lan) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5736
            /*[45:36] i.e. 0x163 for above example address */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5737
            hash_value = ((mc_addr[4] >> 4) | (((u16)mc_addr[5]) << 4));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5738
        } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5739
            /* [45:34] i.e. 0x5D8 for above example address */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5740
            hash_value = ((mc_addr[4] >> 2) | (((u16)mc_addr[5]) << 6));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5741
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5742
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5743
    case 3:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5744
        if (hw->mac_type == e1000_ich8lan) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5745
            /* [43:34] i.e. 0x18D for above example address */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5746
            hash_value = ((mc_addr[4] >> 2) | (((u16)mc_addr[5]) << 6));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5747
        } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5748
            /* [43:32] i.e. 0x634 for above example address */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5749
            hash_value = ((mc_addr[4]) | (((u16)mc_addr[5]) << 8));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5750
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5751
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5752
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5753
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5754
    hash_value &= 0xFFF;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5755
    if (hw->mac_type == e1000_ich8lan)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5756
        hash_value &= 0x3FF;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5757
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5758
    return hash_value;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5759
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5760
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5761
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5762
 * Sets the bit in the multicast table corresponding to the hash value.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5763
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5764
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5765
 * hash_value - Multicast address hash value
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5766
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5767
void e1000_mta_set(struct e1000_hw *hw, u32 hash_value)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5768
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5769
    u32 hash_bit, hash_reg;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5770
    u32 mta;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5771
    u32 temp;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5772
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5773
    /* The MTA is a register array of 128 32-bit registers.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5774
     * It is treated like an array of 4096 bits.  We want to set
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5775
     * bit BitArray[hash_value]. So we figure out what register
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5776
     * the bit is in, read it, OR in the new bit, then write
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5777
     * back the new value.  The register is determined by the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5778
     * upper 7 bits of the hash value and the bit within that
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5779
     * register are determined by the lower 5 bits of the value.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5780
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5781
    hash_reg = (hash_value >> 5) & 0x7F;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5782
    if (hw->mac_type == e1000_ich8lan)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5783
        hash_reg &= 0x1F;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5784
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5785
    hash_bit = hash_value & 0x1F;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5786
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5787
    mta = E1000_READ_REG_ARRAY(hw, MTA, hash_reg);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5788
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5789
    mta |= (1 << hash_bit);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5790
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5791
    /* If we are on an 82544 and we are trying to write an odd offset
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5792
     * in the MTA, save off the previous entry before writing and
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5793
     * restore the old value after writing.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5794
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5795
    if ((hw->mac_type == e1000_82544) && ((hash_reg & 0x1) == 1)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5796
        temp = E1000_READ_REG_ARRAY(hw, MTA, (hash_reg - 1));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5797
        E1000_WRITE_REG_ARRAY(hw, MTA, hash_reg, mta);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5798
        E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5799
        E1000_WRITE_REG_ARRAY(hw, MTA, (hash_reg - 1), temp);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5800
        E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5801
    } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5802
        E1000_WRITE_REG_ARRAY(hw, MTA, hash_reg, mta);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5803
        E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5804
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5805
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5806
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5807
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5808
 * Puts an ethernet address into a receive address register.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5809
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5810
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5811
 * addr - Address to put into receive address register
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5812
 * index - Receive address register to write
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5813
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5814
void e1000_rar_set(struct e1000_hw *hw, u8 *addr, u32 index)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5815
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5816
    u32 rar_low, rar_high;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5817
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5818
    /* HW expects these in little endian so we reverse the byte order
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5819
     * from network order (big endian) to little endian
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5820
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5821
    rar_low = ((u32)addr[0] | ((u32)addr[1] << 8) |
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5822
               ((u32)addr[2] << 16) | ((u32)addr[3] << 24));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5823
    rar_high = ((u32)addr[4] | ((u32)addr[5] << 8));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5824
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5825
    /* Disable Rx and flush all Rx frames before enabling RSS to avoid Rx
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5826
     * unit hang.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5827
     *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5828
     * Description:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5829
     * If there are any Rx frames queued up or otherwise present in the HW
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5830
     * before RSS is enabled, and then we enable RSS, the HW Rx unit will
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5831
     * hang.  To work around this issue, we have to disable receives and
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5832
     * flush out all Rx frames before we enable RSS. To do so, we modify we
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5833
     * redirect all Rx traffic to manageability and then reset the HW.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5834
     * This flushes away Rx frames, and (since the redirections to
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5835
     * manageability persists across resets) keeps new ones from coming in
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5836
     * while we work.  Then, we clear the Address Valid AV bit for all MAC
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5837
     * addresses and undo the re-direction to manageability.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5838
     * Now, frames are coming in again, but the MAC won't accept them, so
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5839
     * far so good.  We now proceed to initialize RSS (if necessary) and
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5840
     * configure the Rx unit.  Last, we re-enable the AV bits and continue
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5841
     * on our merry way.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5842
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5843
    switch (hw->mac_type) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5844
    case e1000_82571:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5845
    case e1000_82572:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5846
    case e1000_80003es2lan:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5847
        if (hw->leave_av_bit_off)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5848
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5849
    default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5850
        /* Indicate to hardware the Address is Valid. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5851
        rar_high |= E1000_RAH_AV;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5852
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5853
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5854
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5855
    E1000_WRITE_REG_ARRAY(hw, RA, (index << 1), rar_low);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5856
    E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5857
    E1000_WRITE_REG_ARRAY(hw, RA, ((index << 1) + 1), rar_high);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5858
    E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5859
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5860
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5861
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5862
 * Writes a value to the specified offset in the VLAN filter table.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5863
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5864
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5865
 * offset - Offset in VLAN filer table to write
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5866
 * value - Value to write into VLAN filter table
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5867
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5868
void e1000_write_vfta(struct e1000_hw *hw, u32 offset, u32 value)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5869
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5870
    u32 temp;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5871
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5872
    if (hw->mac_type == e1000_ich8lan)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5873
        return;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5874
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5875
    if ((hw->mac_type == e1000_82544) && ((offset & 0x1) == 1)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5876
        temp = E1000_READ_REG_ARRAY(hw, VFTA, (offset - 1));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5877
        E1000_WRITE_REG_ARRAY(hw, VFTA, offset, value);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5878
        E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5879
        E1000_WRITE_REG_ARRAY(hw, VFTA, (offset - 1), temp);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5880
        E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5881
    } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5882
        E1000_WRITE_REG_ARRAY(hw, VFTA, offset, value);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5883
        E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5884
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5885
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5886
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5887
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5888
 * Clears the VLAN filer table
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5889
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5890
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5891
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5892
static void e1000_clear_vfta(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5893
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5894
    u32 offset;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5895
    u32 vfta_value = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5896
    u32 vfta_offset = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5897
    u32 vfta_bit_in_reg = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5898
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5899
    if (hw->mac_type == e1000_ich8lan)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5900
        return;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5901
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5902
    if (hw->mac_type == e1000_82573) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5903
        if (hw->mng_cookie.vlan_id != 0) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5904
            /* The VFTA is a 4096b bit-field, each identifying a single VLAN
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5905
             * ID.  The following operations determine which 32b entry
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5906
             * (i.e. offset) into the array we want to set the VLAN ID
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5907
             * (i.e. bit) of the manageability unit. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5908
            vfta_offset = (hw->mng_cookie.vlan_id >>
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5909
                           E1000_VFTA_ENTRY_SHIFT) &
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5910
                          E1000_VFTA_ENTRY_MASK;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5911
            vfta_bit_in_reg = 1 << (hw->mng_cookie.vlan_id &
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5912
                                    E1000_VFTA_ENTRY_BIT_SHIFT_MASK);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5913
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5914
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5915
    for (offset = 0; offset < E1000_VLAN_FILTER_TBL_SIZE; offset++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5916
        /* If the offset we want to clear is the same offset of the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5917
         * manageability VLAN ID, then clear all bits except that of the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5918
         * manageability unit */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5919
        vfta_value = (offset == vfta_offset) ? vfta_bit_in_reg : 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5920
        E1000_WRITE_REG_ARRAY(hw, VFTA, offset, vfta_value);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5921
        E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5922
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5923
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5924
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5925
static s32 e1000_id_led_init(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5926
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5927
    u32 ledctl;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5928
    const u32 ledctl_mask = 0x000000FF;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5929
    const u32 ledctl_on = E1000_LEDCTL_MODE_LED_ON;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5930
    const u32 ledctl_off = E1000_LEDCTL_MODE_LED_OFF;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5931
    u16 eeprom_data, i, temp;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5932
    const u16 led_mask = 0x0F;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5933
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5934
    DEBUGFUNC("e1000_id_led_init");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5935
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5936
    if (hw->mac_type < e1000_82540) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5937
        /* Nothing to do */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5938
        return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5939
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5940
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5941
    ledctl = er32(LEDCTL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5942
    hw->ledctl_default = ledctl;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5943
    hw->ledctl_mode1 = hw->ledctl_default;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5944
    hw->ledctl_mode2 = hw->ledctl_default;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5945
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5946
    if (e1000_read_eeprom(hw, EEPROM_ID_LED_SETTINGS, 1, &eeprom_data) < 0) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5947
        DEBUGOUT("EEPROM Read Error\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5948
        return -E1000_ERR_EEPROM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5949
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5950
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5951
    if ((hw->mac_type == e1000_82573) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5952
        (eeprom_data == ID_LED_RESERVED_82573))
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5953
        eeprom_data = ID_LED_DEFAULT_82573;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5954
    else if ((eeprom_data == ID_LED_RESERVED_0000) ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5955
            (eeprom_data == ID_LED_RESERVED_FFFF)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5956
        if (hw->mac_type == e1000_ich8lan)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5957
            eeprom_data = ID_LED_DEFAULT_ICH8LAN;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5958
        else
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5959
            eeprom_data = ID_LED_DEFAULT;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5960
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5961
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5962
    for (i = 0; i < 4; i++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5963
        temp = (eeprom_data >> (i << 2)) & led_mask;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5964
        switch (temp) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5965
        case ID_LED_ON1_DEF2:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5966
        case ID_LED_ON1_ON2:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5967
        case ID_LED_ON1_OFF2:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5968
            hw->ledctl_mode1 &= ~(ledctl_mask << (i << 3));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5969
            hw->ledctl_mode1 |= ledctl_on << (i << 3);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5970
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5971
        case ID_LED_OFF1_DEF2:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5972
        case ID_LED_OFF1_ON2:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5973
        case ID_LED_OFF1_OFF2:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5974
            hw->ledctl_mode1 &= ~(ledctl_mask << (i << 3));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5975
            hw->ledctl_mode1 |= ledctl_off << (i << 3);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5976
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5977
        default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5978
            /* Do nothing */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5979
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5980
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5981
        switch (temp) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5982
        case ID_LED_DEF1_ON2:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5983
        case ID_LED_ON1_ON2:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5984
        case ID_LED_OFF1_ON2:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5985
            hw->ledctl_mode2 &= ~(ledctl_mask << (i << 3));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5986
            hw->ledctl_mode2 |= ledctl_on << (i << 3);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5987
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5988
        case ID_LED_DEF1_OFF2:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5989
        case ID_LED_ON1_OFF2:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5990
        case ID_LED_OFF1_OFF2:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5991
            hw->ledctl_mode2 &= ~(ledctl_mask << (i << 3));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5992
            hw->ledctl_mode2 |= ledctl_off << (i << 3);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5993
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5994
        default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5995
            /* Do nothing */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5996
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5997
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5998
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  5999
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6000
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6001
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6002
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6003
 * Prepares SW controlable LED for use and saves the current state of the LED.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6004
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6005
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6006
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6007
s32 e1000_setup_led(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6008
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6009
    u32 ledctl;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6010
    s32 ret_val = E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6011
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6012
    DEBUGFUNC("e1000_setup_led");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6013
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6014
    switch (hw->mac_type) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6015
    case e1000_82542_rev2_0:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6016
    case e1000_82542_rev2_1:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6017
    case e1000_82543:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6018
    case e1000_82544:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6019
        /* No setup necessary */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6020
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6021
    case e1000_82541:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6022
    case e1000_82547:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6023
    case e1000_82541_rev_2:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6024
    case e1000_82547_rev_2:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6025
        /* Turn off PHY Smart Power Down (if enabled) */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6026
        ret_val = e1000_read_phy_reg(hw, IGP01E1000_GMII_FIFO,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6027
                                     &hw->phy_spd_default);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6028
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6029
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6030
        ret_val = e1000_write_phy_reg(hw, IGP01E1000_GMII_FIFO,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6031
                                      (u16)(hw->phy_spd_default &
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6032
                                      ~IGP01E1000_GMII_SPD));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6033
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6034
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6035
        /* Fall Through */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6036
    default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6037
        if (hw->media_type == e1000_media_type_fiber) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6038
            ledctl = er32(LEDCTL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6039
            /* Save current LEDCTL settings */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6040
            hw->ledctl_default = ledctl;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6041
            /* Turn off LED0 */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6042
            ledctl &= ~(E1000_LEDCTL_LED0_IVRT |
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6043
                        E1000_LEDCTL_LED0_BLINK |
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6044
                        E1000_LEDCTL_LED0_MODE_MASK);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6045
            ledctl |= (E1000_LEDCTL_MODE_LED_OFF <<
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6046
                       E1000_LEDCTL_LED0_MODE_SHIFT);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6047
            ew32(LEDCTL, ledctl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6048
        } else if (hw->media_type == e1000_media_type_copper)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6049
            ew32(LEDCTL, hw->ledctl_mode1);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6050
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6051
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6052
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6053
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6054
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6055
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6056
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6057
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6058
 * Used on 82571 and later Si that has LED blink bits.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6059
 * Callers must use their own timer and should have already called
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6060
 * e1000_id_led_init()
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6061
 * Call e1000_cleanup led() to stop blinking
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6062
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6063
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6064
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6065
s32 e1000_blink_led_start(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6066
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6067
    s16  i;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6068
    u32 ledctl_blink = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6069
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6070
    DEBUGFUNC("e1000_id_led_blink_on");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6071
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6072
    if (hw->mac_type < e1000_82571) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6073
        /* Nothing to do */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6074
        return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6075
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6076
    if (hw->media_type == e1000_media_type_fiber) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6077
        /* always blink LED0 for PCI-E fiber */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6078
        ledctl_blink = E1000_LEDCTL_LED0_BLINK |
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6079
                     (E1000_LEDCTL_MODE_LED_ON << E1000_LEDCTL_LED0_MODE_SHIFT);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6080
    } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6081
        /* set the blink bit for each LED that's "on" (0x0E) in ledctl_mode2 */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6082
        ledctl_blink = hw->ledctl_mode2;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6083
        for (i=0; i < 4; i++)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6084
            if (((hw->ledctl_mode2 >> (i * 8)) & 0xFF) ==
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6085
                E1000_LEDCTL_MODE_LED_ON)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6086
                ledctl_blink |= (E1000_LEDCTL_LED0_BLINK << (i * 8));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6087
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6088
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6089
    ew32(LEDCTL, ledctl_blink);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6090
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6091
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6092
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6093
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6094
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6095
 * Restores the saved state of the SW controlable LED.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6096
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6097
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6098
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6099
s32 e1000_cleanup_led(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6100
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6101
    s32 ret_val = E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6102
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6103
    DEBUGFUNC("e1000_cleanup_led");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6104
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6105
    switch (hw->mac_type) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6106
    case e1000_82542_rev2_0:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6107
    case e1000_82542_rev2_1:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6108
    case e1000_82543:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6109
    case e1000_82544:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6110
        /* No cleanup necessary */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6111
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6112
    case e1000_82541:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6113
    case e1000_82547:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6114
    case e1000_82541_rev_2:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6115
    case e1000_82547_rev_2:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6116
        /* Turn on PHY Smart Power Down (if previously enabled) */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6117
        ret_val = e1000_write_phy_reg(hw, IGP01E1000_GMII_FIFO,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6118
                                      hw->phy_spd_default);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6119
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6120
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6121
        /* Fall Through */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6122
    default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6123
        if (hw->phy_type == e1000_phy_ife) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6124
            e1000_write_phy_reg(hw, IFE_PHY_SPECIAL_CONTROL_LED, 0);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6125
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6126
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6127
        /* Restore LEDCTL settings */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6128
        ew32(LEDCTL, hw->ledctl_default);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6129
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6130
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6131
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6132
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6133
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6134
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6135
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6136
 * Turns on the software controllable LED
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6137
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6138
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6139
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6140
s32 e1000_led_on(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6141
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6142
    u32 ctrl = er32(CTRL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6143
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6144
    DEBUGFUNC("e1000_led_on");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6145
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6146
    switch (hw->mac_type) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6147
    case e1000_82542_rev2_0:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6148
    case e1000_82542_rev2_1:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6149
    case e1000_82543:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6150
        /* Set SW Defineable Pin 0 to turn on the LED */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6151
        ctrl |= E1000_CTRL_SWDPIN0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6152
        ctrl |= E1000_CTRL_SWDPIO0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6153
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6154
    case e1000_82544:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6155
        if (hw->media_type == e1000_media_type_fiber) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6156
            /* Set SW Defineable Pin 0 to turn on the LED */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6157
            ctrl |= E1000_CTRL_SWDPIN0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6158
            ctrl |= E1000_CTRL_SWDPIO0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6159
        } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6160
            /* Clear SW Defineable Pin 0 to turn on the LED */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6161
            ctrl &= ~E1000_CTRL_SWDPIN0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6162
            ctrl |= E1000_CTRL_SWDPIO0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6163
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6164
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6165
    default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6166
        if (hw->media_type == e1000_media_type_fiber) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6167
            /* Clear SW Defineable Pin 0 to turn on the LED */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6168
            ctrl &= ~E1000_CTRL_SWDPIN0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6169
            ctrl |= E1000_CTRL_SWDPIO0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6170
        } else if (hw->phy_type == e1000_phy_ife) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6171
            e1000_write_phy_reg(hw, IFE_PHY_SPECIAL_CONTROL_LED,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6172
                 (IFE_PSCL_PROBE_MODE | IFE_PSCL_PROBE_LEDS_ON));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6173
        } else if (hw->media_type == e1000_media_type_copper) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6174
            ew32(LEDCTL, hw->ledctl_mode2);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6175
            return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6176
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6177
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6178
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6179
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6180
    ew32(CTRL, ctrl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6181
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6182
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6183
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6184
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6185
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6186
 * Turns off the software controllable LED
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6187
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6188
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6189
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6190
s32 e1000_led_off(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6191
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6192
    u32 ctrl = er32(CTRL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6193
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6194
    DEBUGFUNC("e1000_led_off");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6195
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6196
    switch (hw->mac_type) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6197
    case e1000_82542_rev2_0:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6198
    case e1000_82542_rev2_1:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6199
    case e1000_82543:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6200
        /* Clear SW Defineable Pin 0 to turn off the LED */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6201
        ctrl &= ~E1000_CTRL_SWDPIN0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6202
        ctrl |= E1000_CTRL_SWDPIO0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6203
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6204
    case e1000_82544:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6205
        if (hw->media_type == e1000_media_type_fiber) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6206
            /* Clear SW Defineable Pin 0 to turn off the LED */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6207
            ctrl &= ~E1000_CTRL_SWDPIN0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6208
            ctrl |= E1000_CTRL_SWDPIO0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6209
        } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6210
            /* Set SW Defineable Pin 0 to turn off the LED */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6211
            ctrl |= E1000_CTRL_SWDPIN0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6212
            ctrl |= E1000_CTRL_SWDPIO0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6213
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6214
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6215
    default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6216
        if (hw->media_type == e1000_media_type_fiber) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6217
            /* Set SW Defineable Pin 0 to turn off the LED */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6218
            ctrl |= E1000_CTRL_SWDPIN0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6219
            ctrl |= E1000_CTRL_SWDPIO0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6220
        } else if (hw->phy_type == e1000_phy_ife) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6221
            e1000_write_phy_reg(hw, IFE_PHY_SPECIAL_CONTROL_LED,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6222
                 (IFE_PSCL_PROBE_MODE | IFE_PSCL_PROBE_LEDS_OFF));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6223
        } else if (hw->media_type == e1000_media_type_copper) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6224
            ew32(LEDCTL, hw->ledctl_mode1);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6225
            return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6226
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6227
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6228
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6229
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6230
    ew32(CTRL, ctrl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6231
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6232
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6233
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6234
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6235
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6236
 * Clears all hardware statistics counters.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6237
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6238
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6239
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6240
static void e1000_clear_hw_cntrs(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6241
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6242
    volatile u32 temp;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6243
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6244
    temp = er32(CRCERRS);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6245
    temp = er32(SYMERRS);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6246
    temp = er32(MPC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6247
    temp = er32(SCC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6248
    temp = er32(ECOL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6249
    temp = er32(MCC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6250
    temp = er32(LATECOL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6251
    temp = er32(COLC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6252
    temp = er32(DC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6253
    temp = er32(SEC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6254
    temp = er32(RLEC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6255
    temp = er32(XONRXC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6256
    temp = er32(XONTXC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6257
    temp = er32(XOFFRXC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6258
    temp = er32(XOFFTXC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6259
    temp = er32(FCRUC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6260
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6261
    if (hw->mac_type != e1000_ich8lan) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6262
    temp = er32(PRC64);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6263
    temp = er32(PRC127);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6264
    temp = er32(PRC255);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6265
    temp = er32(PRC511);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6266
    temp = er32(PRC1023);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6267
    temp = er32(PRC1522);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6268
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6269
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6270
    temp = er32(GPRC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6271
    temp = er32(BPRC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6272
    temp = er32(MPRC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6273
    temp = er32(GPTC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6274
    temp = er32(GORCL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6275
    temp = er32(GORCH);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6276
    temp = er32(GOTCL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6277
    temp = er32(GOTCH);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6278
    temp = er32(RNBC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6279
    temp = er32(RUC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6280
    temp = er32(RFC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6281
    temp = er32(ROC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6282
    temp = er32(RJC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6283
    temp = er32(TORL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6284
    temp = er32(TORH);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6285
    temp = er32(TOTL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6286
    temp = er32(TOTH);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6287
    temp = er32(TPR);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6288
    temp = er32(TPT);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6289
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6290
    if (hw->mac_type != e1000_ich8lan) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6291
    temp = er32(PTC64);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6292
    temp = er32(PTC127);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6293
    temp = er32(PTC255);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6294
    temp = er32(PTC511);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6295
    temp = er32(PTC1023);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6296
    temp = er32(PTC1522);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6297
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6298
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6299
    temp = er32(MPTC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6300
    temp = er32(BPTC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6301
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6302
    if (hw->mac_type < e1000_82543) return;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6303
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6304
    temp = er32(ALGNERRC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6305
    temp = er32(RXERRC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6306
    temp = er32(TNCRS);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6307
    temp = er32(CEXTERR);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6308
    temp = er32(TSCTC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6309
    temp = er32(TSCTFC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6310
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6311
    if (hw->mac_type <= e1000_82544) return;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6312
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6313
    temp = er32(MGTPRC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6314
    temp = er32(MGTPDC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6315
    temp = er32(MGTPTC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6316
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6317
    if (hw->mac_type <= e1000_82547_rev_2) return;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6318
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6319
    temp = er32(IAC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6320
    temp = er32(ICRXOC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6321
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6322
    if (hw->mac_type == e1000_ich8lan) return;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6323
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6324
    temp = er32(ICRXPTC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6325
    temp = er32(ICRXATC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6326
    temp = er32(ICTXPTC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6327
    temp = er32(ICTXATC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6328
    temp = er32(ICTXQEC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6329
    temp = er32(ICTXQMTC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6330
    temp = er32(ICRXDMTC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6331
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6332
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6333
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6334
 * Resets Adaptive IFS to its default state.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6335
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6336
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6337
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6338
 * Call this after e1000_init_hw. You may override the IFS defaults by setting
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6339
 * hw->ifs_params_forced to true. However, you must initialize hw->
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6340
 * current_ifs_val, ifs_min_val, ifs_max_val, ifs_step_size, and ifs_ratio
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6341
 * before calling this function.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6342
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6343
void e1000_reset_adaptive(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6344
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6345
    DEBUGFUNC("e1000_reset_adaptive");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6346
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6347
    if (hw->adaptive_ifs) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6348
        if (!hw->ifs_params_forced) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6349
            hw->current_ifs_val = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6350
            hw->ifs_min_val = IFS_MIN;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6351
            hw->ifs_max_val = IFS_MAX;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6352
            hw->ifs_step_size = IFS_STEP;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6353
            hw->ifs_ratio = IFS_RATIO;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6354
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6355
        hw->in_ifs_mode = false;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6356
        ew32(AIT, 0);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6357
    } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6358
        DEBUGOUT("Not in Adaptive IFS mode!\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6359
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6360
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6361
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6362
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6363
 * Called during the callback/watchdog routine to update IFS value based on
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6364
 * the ratio of transmits to collisions.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6365
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6366
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6367
 * tx_packets - Number of transmits since last callback
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6368
 * total_collisions - Number of collisions since last callback
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6369
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6370
void e1000_update_adaptive(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6371
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6372
    DEBUGFUNC("e1000_update_adaptive");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6373
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6374
    if (hw->adaptive_ifs) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6375
        if ((hw->collision_delta * hw->ifs_ratio) > hw->tx_packet_delta) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6376
            if (hw->tx_packet_delta > MIN_NUM_XMITS) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6377
                hw->in_ifs_mode = true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6378
                if (hw->current_ifs_val < hw->ifs_max_val) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6379
                    if (hw->current_ifs_val == 0)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6380
                        hw->current_ifs_val = hw->ifs_min_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6381
                    else
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6382
                        hw->current_ifs_val += hw->ifs_step_size;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6383
                    ew32(AIT, hw->current_ifs_val);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6384
                }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6385
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6386
        } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6387
            if (hw->in_ifs_mode && (hw->tx_packet_delta <= MIN_NUM_XMITS)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6388
                hw->current_ifs_val = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6389
                hw->in_ifs_mode = false;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6390
                ew32(AIT, 0);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6391
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6392
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6393
    } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6394
        DEBUGOUT("Not in Adaptive IFS mode!\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6395
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6396
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6397
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6398
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6399
 * Adjusts the statistic counters when a frame is accepted by TBI_ACCEPT
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6400
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6401
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6402
 * frame_len - The length of the frame in question
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6403
 * mac_addr - The Ethernet destination address of the frame in question
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6404
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6405
void e1000_tbi_adjust_stats(struct e1000_hw *hw, struct e1000_hw_stats *stats,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6406
			    u32 frame_len, u8 *mac_addr)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6407
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6408
    u64 carry_bit;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6409
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6410
    /* First adjust the frame length. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6411
    frame_len--;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6412
    /* We need to adjust the statistics counters, since the hardware
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6413
     * counters overcount this packet as a CRC error and undercount
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6414
     * the packet as a good packet
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6415
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6416
    /* This packet should not be counted as a CRC error.    */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6417
    stats->crcerrs--;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6418
    /* This packet does count as a Good Packet Received.    */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6419
    stats->gprc++;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6420
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6421
    /* Adjust the Good Octets received counters             */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6422
    carry_bit = 0x80000000 & stats->gorcl;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6423
    stats->gorcl += frame_len;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6424
    /* If the high bit of Gorcl (the low 32 bits of the Good Octets
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6425
     * Received Count) was one before the addition,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6426
     * AND it is zero after, then we lost the carry out,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6427
     * need to add one to Gorch (Good Octets Received Count High).
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6428
     * This could be simplified if all environments supported
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6429
     * 64-bit integers.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6430
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6431
    if (carry_bit && ((stats->gorcl & 0x80000000) == 0))
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6432
        stats->gorch++;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6433
    /* Is this a broadcast or multicast?  Check broadcast first,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6434
     * since the test for a multicast frame will test positive on
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6435
     * a broadcast frame.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6436
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6437
    if ((mac_addr[0] == (u8)0xff) && (mac_addr[1] == (u8)0xff))
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6438
        /* Broadcast packet */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6439
        stats->bprc++;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6440
    else if (*mac_addr & 0x01)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6441
        /* Multicast packet */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6442
        stats->mprc++;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6443
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6444
    if (frame_len == hw->max_frame_size) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6445
        /* In this case, the hardware has overcounted the number of
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6446
         * oversize frames.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6447
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6448
        if (stats->roc > 0)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6449
            stats->roc--;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6450
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6451
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6452
    /* Adjust the bin counters when the extra byte put the frame in the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6453
     * wrong bin. Remember that the frame_len was adjusted above.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6454
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6455
    if (frame_len == 64) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6456
        stats->prc64++;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6457
        stats->prc127--;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6458
    } else if (frame_len == 127) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6459
        stats->prc127++;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6460
        stats->prc255--;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6461
    } else if (frame_len == 255) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6462
        stats->prc255++;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6463
        stats->prc511--;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6464
    } else if (frame_len == 511) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6465
        stats->prc511++;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6466
        stats->prc1023--;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6467
    } else if (frame_len == 1023) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6468
        stats->prc1023++;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6469
        stats->prc1522--;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6470
    } else if (frame_len == 1522) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6471
        stats->prc1522++;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6472
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6473
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6474
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6475
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6476
 * Gets the current PCI bus type, speed, and width of the hardware
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6477
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6478
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6479
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6480
void e1000_get_bus_info(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6481
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6482
    s32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6483
    u16 pci_ex_link_status;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6484
    u32 status;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6485
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6486
    switch (hw->mac_type) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6487
    case e1000_82542_rev2_0:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6488
    case e1000_82542_rev2_1:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6489
        hw->bus_type = e1000_bus_type_pci;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6490
        hw->bus_speed = e1000_bus_speed_unknown;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6491
        hw->bus_width = e1000_bus_width_unknown;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6492
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6493
    case e1000_82571:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6494
    case e1000_82572:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6495
    case e1000_82573:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6496
    case e1000_80003es2lan:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6497
        hw->bus_type = e1000_bus_type_pci_express;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6498
        hw->bus_speed = e1000_bus_speed_2500;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6499
        ret_val = e1000_read_pcie_cap_reg(hw,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6500
                                      PCI_EX_LINK_STATUS,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6501
                                      &pci_ex_link_status);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6502
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6503
            hw->bus_width = e1000_bus_width_unknown;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6504
        else
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6505
            hw->bus_width = (pci_ex_link_status & PCI_EX_LINK_WIDTH_MASK) >>
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6506
                          PCI_EX_LINK_WIDTH_SHIFT;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6507
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6508
    case e1000_ich8lan:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6509
        hw->bus_type = e1000_bus_type_pci_express;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6510
        hw->bus_speed = e1000_bus_speed_2500;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6511
        hw->bus_width = e1000_bus_width_pciex_1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6512
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6513
    default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6514
        status = er32(STATUS);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6515
        hw->bus_type = (status & E1000_STATUS_PCIX_MODE) ?
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6516
                       e1000_bus_type_pcix : e1000_bus_type_pci;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6517
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6518
        if (hw->device_id == E1000_DEV_ID_82546EB_QUAD_COPPER) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6519
            hw->bus_speed = (hw->bus_type == e1000_bus_type_pci) ?
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6520
                            e1000_bus_speed_66 : e1000_bus_speed_120;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6521
        } else if (hw->bus_type == e1000_bus_type_pci) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6522
            hw->bus_speed = (status & E1000_STATUS_PCI66) ?
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6523
                            e1000_bus_speed_66 : e1000_bus_speed_33;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6524
        } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6525
            switch (status & E1000_STATUS_PCIX_SPEED) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6526
            case E1000_STATUS_PCIX_SPEED_66:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6527
                hw->bus_speed = e1000_bus_speed_66;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6528
                break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6529
            case E1000_STATUS_PCIX_SPEED_100:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6530
                hw->bus_speed = e1000_bus_speed_100;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6531
                break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6532
            case E1000_STATUS_PCIX_SPEED_133:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6533
                hw->bus_speed = e1000_bus_speed_133;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6534
                break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6535
            default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6536
                hw->bus_speed = e1000_bus_speed_reserved;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6537
                break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6538
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6539
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6540
        hw->bus_width = (status & E1000_STATUS_BUS64) ?
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6541
                        e1000_bus_width_64 : e1000_bus_width_32;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6542
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6543
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6544
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6545
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6546
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6547
 * Writes a value to one of the devices registers using port I/O (as opposed to
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6548
 * memory mapped I/O). Only 82544 and newer devices support port I/O.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6549
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6550
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6551
 * offset - offset to write to
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6552
 * value - value to write
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6553
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6554
static void e1000_write_reg_io(struct e1000_hw *hw, u32 offset, u32 value)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6555
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6556
    unsigned long io_addr = hw->io_base;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6557
    unsigned long io_data = hw->io_base + 4;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6558
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6559
    e1000_io_write(hw, io_addr, offset);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6560
    e1000_io_write(hw, io_data, value);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6561
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6562
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6563
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6564
 * Estimates the cable length.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6565
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6566
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6567
 * min_length - The estimated minimum length
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6568
 * max_length - The estimated maximum length
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6569
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6570
 * returns: - E1000_ERR_XXX
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6571
 *            E1000_SUCCESS
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6572
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6573
 * This function always returns a ranged length (minimum & maximum).
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6574
 * So for M88 phy's, this function interprets the one value returned from the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6575
 * register to the minimum and maximum range.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6576
 * For IGP phy's, the function calculates the range by the AGC registers.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6577
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6578
static s32 e1000_get_cable_length(struct e1000_hw *hw, u16 *min_length,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6579
				  u16 *max_length)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6580
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6581
    s32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6582
    u16 agc_value = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6583
    u16 i, phy_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6584
    u16 cable_length;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6585
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6586
    DEBUGFUNC("e1000_get_cable_length");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6587
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6588
    *min_length = *max_length = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6589
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6590
    /* Use old method for Phy older than IGP */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6591
    if (hw->phy_type == e1000_phy_m88) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6592
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6593
        ret_val = e1000_read_phy_reg(hw, M88E1000_PHY_SPEC_STATUS,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6594
                                     &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6595
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6596
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6597
        cable_length = (phy_data & M88E1000_PSSR_CABLE_LENGTH) >>
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6598
                       M88E1000_PSSR_CABLE_LENGTH_SHIFT;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6599
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6600
        /* Convert the enum value to ranged values */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6601
        switch (cable_length) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6602
        case e1000_cable_length_50:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6603
            *min_length = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6604
            *max_length = e1000_igp_cable_length_50;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6605
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6606
        case e1000_cable_length_50_80:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6607
            *min_length = e1000_igp_cable_length_50;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6608
            *max_length = e1000_igp_cable_length_80;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6609
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6610
        case e1000_cable_length_80_110:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6611
            *min_length = e1000_igp_cable_length_80;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6612
            *max_length = e1000_igp_cable_length_110;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6613
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6614
        case e1000_cable_length_110_140:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6615
            *min_length = e1000_igp_cable_length_110;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6616
            *max_length = e1000_igp_cable_length_140;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6617
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6618
        case e1000_cable_length_140:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6619
            *min_length = e1000_igp_cable_length_140;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6620
            *max_length = e1000_igp_cable_length_170;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6621
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6622
        default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6623
            return -E1000_ERR_PHY;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6624
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6625
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6626
    } else if (hw->phy_type == e1000_phy_gg82563) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6627
        ret_val = e1000_read_phy_reg(hw, GG82563_PHY_DSP_DISTANCE,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6628
                                     &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6629
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6630
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6631
        cable_length = phy_data & GG82563_DSPD_CABLE_LENGTH;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6632
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6633
        switch (cable_length) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6634
        case e1000_gg_cable_length_60:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6635
            *min_length = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6636
            *max_length = e1000_igp_cable_length_60;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6637
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6638
        case e1000_gg_cable_length_60_115:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6639
            *min_length = e1000_igp_cable_length_60;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6640
            *max_length = e1000_igp_cable_length_115;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6641
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6642
        case e1000_gg_cable_length_115_150:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6643
            *min_length = e1000_igp_cable_length_115;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6644
            *max_length = e1000_igp_cable_length_150;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6645
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6646
        case e1000_gg_cable_length_150:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6647
            *min_length = e1000_igp_cable_length_150;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6648
            *max_length = e1000_igp_cable_length_180;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6649
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6650
        default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6651
            return -E1000_ERR_PHY;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6652
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6653
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6654
    } else if (hw->phy_type == e1000_phy_igp) { /* For IGP PHY */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6655
        u16 cur_agc_value;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6656
        u16 min_agc_value = IGP01E1000_AGC_LENGTH_TABLE_SIZE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6657
        u16 agc_reg_array[IGP01E1000_PHY_CHANNEL_NUM] =
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6658
                                                         {IGP01E1000_PHY_AGC_A,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6659
                                                          IGP01E1000_PHY_AGC_B,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6660
                                                          IGP01E1000_PHY_AGC_C,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6661
                                                          IGP01E1000_PHY_AGC_D};
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6662
        /* Read the AGC registers for all channels */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6663
        for (i = 0; i < IGP01E1000_PHY_CHANNEL_NUM; i++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6664
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6665
            ret_val = e1000_read_phy_reg(hw, agc_reg_array[i], &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6666
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6667
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6668
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6669
            cur_agc_value = phy_data >> IGP01E1000_AGC_LENGTH_SHIFT;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6670
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6671
            /* Value bound check. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6672
            if ((cur_agc_value >= IGP01E1000_AGC_LENGTH_TABLE_SIZE - 1) ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6673
                (cur_agc_value == 0))
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6674
                return -E1000_ERR_PHY;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6675
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6676
            agc_value += cur_agc_value;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6677
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6678
            /* Update minimal AGC value. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6679
            if (min_agc_value > cur_agc_value)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6680
                min_agc_value = cur_agc_value;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6681
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6682
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6683
        /* Remove the minimal AGC result for length < 50m */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6684
        if (agc_value < IGP01E1000_PHY_CHANNEL_NUM * e1000_igp_cable_length_50) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6685
            agc_value -= min_agc_value;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6686
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6687
            /* Get the average length of the remaining 3 channels */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6688
            agc_value /= (IGP01E1000_PHY_CHANNEL_NUM - 1);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6689
        } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6690
            /* Get the average length of all the 4 channels. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6691
            agc_value /= IGP01E1000_PHY_CHANNEL_NUM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6692
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6693
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6694
        /* Set the range of the calculated length. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6695
        *min_length = ((e1000_igp_cable_length_table[agc_value] -
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6696
                       IGP01E1000_AGC_RANGE) > 0) ?
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6697
                       (e1000_igp_cable_length_table[agc_value] -
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6698
                       IGP01E1000_AGC_RANGE) : 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6699
        *max_length = e1000_igp_cable_length_table[agc_value] +
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6700
                      IGP01E1000_AGC_RANGE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6701
    } else if (hw->phy_type == e1000_phy_igp_2 ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6702
               hw->phy_type == e1000_phy_igp_3) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6703
        u16 cur_agc_index, max_agc_index = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6704
        u16 min_agc_index = IGP02E1000_AGC_LENGTH_TABLE_SIZE - 1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6705
        u16 agc_reg_array[IGP02E1000_PHY_CHANNEL_NUM] =
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6706
                                                         {IGP02E1000_PHY_AGC_A,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6707
                                                          IGP02E1000_PHY_AGC_B,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6708
                                                          IGP02E1000_PHY_AGC_C,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6709
                                                          IGP02E1000_PHY_AGC_D};
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6710
        /* Read the AGC registers for all channels */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6711
        for (i = 0; i < IGP02E1000_PHY_CHANNEL_NUM; i++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6712
            ret_val = e1000_read_phy_reg(hw, agc_reg_array[i], &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6713
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6714
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6715
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6716
            /* Getting bits 15:9, which represent the combination of course and
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6717
             * fine gain values.  The result is a number that can be put into
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6718
             * the lookup table to obtain the approximate cable length. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6719
            cur_agc_index = (phy_data >> IGP02E1000_AGC_LENGTH_SHIFT) &
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6720
                            IGP02E1000_AGC_LENGTH_MASK;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6721
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6722
            /* Array index bound check. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6723
            if ((cur_agc_index >= IGP02E1000_AGC_LENGTH_TABLE_SIZE) ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6724
                (cur_agc_index == 0))
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6725
                return -E1000_ERR_PHY;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6726
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6727
            /* Remove min & max AGC values from calculation. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6728
            if (e1000_igp_2_cable_length_table[min_agc_index] >
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6729
                e1000_igp_2_cable_length_table[cur_agc_index])
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6730
                min_agc_index = cur_agc_index;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6731
            if (e1000_igp_2_cable_length_table[max_agc_index] <
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6732
                e1000_igp_2_cable_length_table[cur_agc_index])
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6733
                max_agc_index = cur_agc_index;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6734
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6735
            agc_value += e1000_igp_2_cable_length_table[cur_agc_index];
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6736
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6737
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6738
        agc_value -= (e1000_igp_2_cable_length_table[min_agc_index] +
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6739
                      e1000_igp_2_cable_length_table[max_agc_index]);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6740
        agc_value /= (IGP02E1000_PHY_CHANNEL_NUM - 2);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6741
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6742
        /* Calculate cable length with the error range of +/- 10 meters. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6743
        *min_length = ((agc_value - IGP02E1000_AGC_RANGE) > 0) ?
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6744
                       (agc_value - IGP02E1000_AGC_RANGE) : 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6745
        *max_length = agc_value + IGP02E1000_AGC_RANGE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6746
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6747
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6748
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6749
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6750
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6751
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6752
 * Check the cable polarity
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6753
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6754
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6755
 * polarity - output parameter : 0 - Polarity is not reversed
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6756
 *                               1 - Polarity is reversed.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6757
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6758
 * returns: - E1000_ERR_XXX
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6759
 *            E1000_SUCCESS
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6760
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6761
 * For phy's older than IGP, this function simply reads the polarity bit in the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6762
 * Phy Status register.  For IGP phy's, this bit is valid only if link speed is
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6763
 * 10 Mbps.  If the link speed is 100 Mbps there is no polarity so this bit will
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6764
 * return 0.  If the link speed is 1000 Mbps the polarity status is in the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6765
 * IGP01E1000_PHY_PCS_INIT_REG.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6766
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6767
static s32 e1000_check_polarity(struct e1000_hw *hw,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6768
				e1000_rev_polarity *polarity)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6769
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6770
    s32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6771
    u16 phy_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6772
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6773
    DEBUGFUNC("e1000_check_polarity");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6774
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6775
    if ((hw->phy_type == e1000_phy_m88) ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6776
        (hw->phy_type == e1000_phy_gg82563)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6777
        /* return the Polarity bit in the Status register. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6778
        ret_val = e1000_read_phy_reg(hw, M88E1000_PHY_SPEC_STATUS,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6779
                                     &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6780
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6781
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6782
        *polarity = ((phy_data & M88E1000_PSSR_REV_POLARITY) >>
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6783
                     M88E1000_PSSR_REV_POLARITY_SHIFT) ?
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6784
                     e1000_rev_polarity_reversed : e1000_rev_polarity_normal;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6785
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6786
    } else if (hw->phy_type == e1000_phy_igp ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6787
              hw->phy_type == e1000_phy_igp_3 ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6788
              hw->phy_type == e1000_phy_igp_2) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6789
        /* Read the Status register to check the speed */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6790
        ret_val = e1000_read_phy_reg(hw, IGP01E1000_PHY_PORT_STATUS,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6791
                                     &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6792
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6793
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6794
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6795
        /* If speed is 1000 Mbps, must read the IGP01E1000_PHY_PCS_INIT_REG to
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6796
         * find the polarity status */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6797
        if ((phy_data & IGP01E1000_PSSR_SPEED_MASK) ==
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6798
           IGP01E1000_PSSR_SPEED_1000MBPS) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6799
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6800
            /* Read the GIG initialization PCS register (0x00B4) */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6801
            ret_val = e1000_read_phy_reg(hw, IGP01E1000_PHY_PCS_INIT_REG,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6802
                                         &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6803
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6804
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6805
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6806
            /* Check the polarity bits */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6807
            *polarity = (phy_data & IGP01E1000_PHY_POLARITY_MASK) ?
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6808
                         e1000_rev_polarity_reversed : e1000_rev_polarity_normal;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6809
        } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6810
            /* For 10 Mbps, read the polarity bit in the status register. (for
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6811
             * 100 Mbps this bit is always 0) */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6812
            *polarity = (phy_data & IGP01E1000_PSSR_POLARITY_REVERSED) ?
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6813
                         e1000_rev_polarity_reversed : e1000_rev_polarity_normal;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6814
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6815
    } else if (hw->phy_type == e1000_phy_ife) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6816
        ret_val = e1000_read_phy_reg(hw, IFE_PHY_EXTENDED_STATUS_CONTROL,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6817
                                     &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6818
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6819
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6820
        *polarity = ((phy_data & IFE_PESC_POLARITY_REVERSED) >>
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6821
                     IFE_PESC_POLARITY_REVERSED_SHIFT) ?
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6822
                     e1000_rev_polarity_reversed : e1000_rev_polarity_normal;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6823
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6824
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6825
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6826
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6827
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6828
 * Check if Downshift occured
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6829
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6830
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6831
 * downshift - output parameter : 0 - No Downshift ocured.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6832
 *                                1 - Downshift ocured.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6833
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6834
 * returns: - E1000_ERR_XXX
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6835
 *            E1000_SUCCESS
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6836
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6837
 * For phy's older than IGP, this function reads the Downshift bit in the Phy
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6838
 * Specific Status register.  For IGP phy's, it reads the Downgrade bit in the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6839
 * Link Health register.  In IGP this bit is latched high, so the driver must
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6840
 * read it immediately after link is established.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6841
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6842
static s32 e1000_check_downshift(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6843
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6844
    s32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6845
    u16 phy_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6846
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6847
    DEBUGFUNC("e1000_check_downshift");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6848
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6849
    if (hw->phy_type == e1000_phy_igp ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6850
        hw->phy_type == e1000_phy_igp_3 ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6851
        hw->phy_type == e1000_phy_igp_2) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6852
        ret_val = e1000_read_phy_reg(hw, IGP01E1000_PHY_LINK_HEALTH,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6853
                                     &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6854
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6855
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6856
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6857
        hw->speed_downgraded = (phy_data & IGP01E1000_PLHR_SS_DOWNGRADE) ? 1 : 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6858
    } else if ((hw->phy_type == e1000_phy_m88) ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6859
               (hw->phy_type == e1000_phy_gg82563)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6860
        ret_val = e1000_read_phy_reg(hw, M88E1000_PHY_SPEC_STATUS,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6861
                                     &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6862
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6863
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6864
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6865
        hw->speed_downgraded = (phy_data & M88E1000_PSSR_DOWNSHIFT) >>
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6866
                               M88E1000_PSSR_DOWNSHIFT_SHIFT;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6867
    } else if (hw->phy_type == e1000_phy_ife) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6868
        /* e1000_phy_ife supports 10/100 speed only */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6869
        hw->speed_downgraded = false;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6870
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6871
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6872
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6873
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6874
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6875
/*****************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6876
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6877
 * 82541_rev_2 & 82547_rev_2 have the capability to configure the DSP when a
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6878
 * gigabit link is achieved to improve link quality.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6879
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6880
 * hw: Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6881
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6882
 * returns: - E1000_ERR_PHY if fail to read/write the PHY
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6883
 *            E1000_SUCCESS at any other case.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6884
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6885
 ****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6886
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6887
static s32 e1000_config_dsp_after_link_change(struct e1000_hw *hw, bool link_up)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6888
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6889
    s32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6890
    u16 phy_data, phy_saved_data, speed, duplex, i;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6891
    u16 dsp_reg_array[IGP01E1000_PHY_CHANNEL_NUM] =
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6892
                                        {IGP01E1000_PHY_AGC_PARAM_A,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6893
                                        IGP01E1000_PHY_AGC_PARAM_B,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6894
                                        IGP01E1000_PHY_AGC_PARAM_C,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6895
                                        IGP01E1000_PHY_AGC_PARAM_D};
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6896
    u16 min_length, max_length;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6897
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6898
    DEBUGFUNC("e1000_config_dsp_after_link_change");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6899
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6900
    if (hw->phy_type != e1000_phy_igp)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6901
        return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6902
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6903
    if (link_up) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6904
        ret_val = e1000_get_speed_and_duplex(hw, &speed, &duplex);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6905
        if (ret_val) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6906
            DEBUGOUT("Error getting link speed and duplex\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6907
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6908
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6909
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6910
        if (speed == SPEED_1000) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6911
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6912
            ret_val = e1000_get_cable_length(hw, &min_length, &max_length);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6913
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6914
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6915
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6916
            if ((hw->dsp_config_state == e1000_dsp_config_enabled) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6917
                min_length >= e1000_igp_cable_length_50) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6918
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6919
                for (i = 0; i < IGP01E1000_PHY_CHANNEL_NUM; i++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6920
                    ret_val = e1000_read_phy_reg(hw, dsp_reg_array[i],
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6921
                                                 &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6922
                    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6923
                        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6924
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6925
                    phy_data &= ~IGP01E1000_PHY_EDAC_MU_INDEX;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6926
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6927
                    ret_val = e1000_write_phy_reg(hw, dsp_reg_array[i],
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6928
                                                  phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6929
                    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6930
                        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6931
                }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6932
                hw->dsp_config_state = e1000_dsp_config_activated;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6933
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6934
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6935
            if ((hw->ffe_config_state == e1000_ffe_config_enabled) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6936
               (min_length < e1000_igp_cable_length_50)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6937
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6938
                u16 ffe_idle_err_timeout = FFE_IDLE_ERR_COUNT_TIMEOUT_20;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6939
                u32 idle_errs = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6940
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6941
                /* clear previous idle error counts */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6942
                ret_val = e1000_read_phy_reg(hw, PHY_1000T_STATUS,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6943
                                             &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6944
                if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6945
                    return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6946
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6947
                for (i = 0; i < ffe_idle_err_timeout; i++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6948
                    udelay(1000);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6949
                    ret_val = e1000_read_phy_reg(hw, PHY_1000T_STATUS,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6950
                                                 &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6951
                    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6952
                        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6953
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6954
                    idle_errs += (phy_data & SR_1000T_IDLE_ERROR_CNT);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6955
                    if (idle_errs > SR_1000T_PHY_EXCESSIVE_IDLE_ERR_COUNT) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6956
                        hw->ffe_config_state = e1000_ffe_config_active;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6957
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6958
                        ret_val = e1000_write_phy_reg(hw,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6959
                                    IGP01E1000_PHY_DSP_FFE,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6960
                                    IGP01E1000_PHY_DSP_FFE_CM_CP);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6961
                        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6962
                            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6963
                        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6964
                    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6965
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6966
                    if (idle_errs)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6967
                        ffe_idle_err_timeout = FFE_IDLE_ERR_COUNT_TIMEOUT_100;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6968
                }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6969
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6970
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6971
    } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6972
        if (hw->dsp_config_state == e1000_dsp_config_activated) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6973
            /* Save off the current value of register 0x2F5B to be restored at
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6974
             * the end of the routines. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6975
            ret_val = e1000_read_phy_reg(hw, 0x2F5B, &phy_saved_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6976
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6977
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6978
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6979
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6980
            /* Disable the PHY transmitter */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6981
            ret_val = e1000_write_phy_reg(hw, 0x2F5B, 0x0003);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6982
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6983
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6984
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6985
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6986
            mdelay(20);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6987
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6988
            ret_val = e1000_write_phy_reg(hw, 0x0000,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6989
                                          IGP01E1000_IEEE_FORCE_GIGA);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6990
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6991
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6992
            for (i = 0; i < IGP01E1000_PHY_CHANNEL_NUM; i++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6993
                ret_val = e1000_read_phy_reg(hw, dsp_reg_array[i], &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6994
                if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6995
                    return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6996
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6997
                phy_data &= ~IGP01E1000_PHY_EDAC_MU_INDEX;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6998
                phy_data |=  IGP01E1000_PHY_EDAC_SIGN_EXT_9_BITS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  6999
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7000
                ret_val = e1000_write_phy_reg(hw,dsp_reg_array[i], phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7001
                if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7002
                    return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7003
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7004
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7005
            ret_val = e1000_write_phy_reg(hw, 0x0000,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7006
                                          IGP01E1000_IEEE_RESTART_AUTONEG);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7007
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7008
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7009
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7010
            mdelay(20);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7011
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7012
            /* Now enable the transmitter */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7013
            ret_val = e1000_write_phy_reg(hw, 0x2F5B, phy_saved_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7014
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7015
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7016
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7017
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7018
            hw->dsp_config_state = e1000_dsp_config_enabled;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7019
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7020
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7021
        if (hw->ffe_config_state == e1000_ffe_config_active) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7022
            /* Save off the current value of register 0x2F5B to be restored at
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7023
             * the end of the routines. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7024
            ret_val = e1000_read_phy_reg(hw, 0x2F5B, &phy_saved_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7025
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7026
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7027
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7028
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7029
            /* Disable the PHY transmitter */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7030
            ret_val = e1000_write_phy_reg(hw, 0x2F5B, 0x0003);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7031
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7032
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7033
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7034
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7035
            mdelay(20);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7036
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7037
            ret_val = e1000_write_phy_reg(hw, 0x0000,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7038
                                          IGP01E1000_IEEE_FORCE_GIGA);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7039
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7040
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7041
            ret_val = e1000_write_phy_reg(hw, IGP01E1000_PHY_DSP_FFE,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7042
                                          IGP01E1000_PHY_DSP_FFE_DEFAULT);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7043
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7044
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7045
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7046
            ret_val = e1000_write_phy_reg(hw, 0x0000,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7047
                                          IGP01E1000_IEEE_RESTART_AUTONEG);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7048
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7049
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7050
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7051
            mdelay(20);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7052
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7053
            /* Now enable the transmitter */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7054
            ret_val = e1000_write_phy_reg(hw, 0x2F5B, phy_saved_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7055
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7056
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7057
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7058
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7059
            hw->ffe_config_state = e1000_ffe_config_enabled;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7060
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7061
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7062
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7063
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7064
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7065
/*****************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7066
 * Set PHY to class A mode
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7067
 * Assumes the following operations will follow to enable the new class mode.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7068
 *  1. Do a PHY soft reset
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7069
 *  2. Restart auto-negotiation or force link.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7070
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7071
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7072
 ****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7073
static s32 e1000_set_phy_mode(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7074
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7075
    s32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7076
    u16 eeprom_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7077
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7078
    DEBUGFUNC("e1000_set_phy_mode");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7079
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7080
    if ((hw->mac_type == e1000_82545_rev_3) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7081
        (hw->media_type == e1000_media_type_copper)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7082
        ret_val = e1000_read_eeprom(hw, EEPROM_PHY_CLASS_WORD, 1, &eeprom_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7083
        if (ret_val) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7084
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7085
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7086
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7087
        if ((eeprom_data != EEPROM_RESERVED_WORD) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7088
            (eeprom_data & EEPROM_PHY_CLASS_A)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7089
            ret_val = e1000_write_phy_reg(hw, M88E1000_PHY_PAGE_SELECT, 0x000B);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7090
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7091
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7092
            ret_val = e1000_write_phy_reg(hw, M88E1000_PHY_GEN_CONTROL, 0x8104);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7093
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7094
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7095
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7096
            hw->phy_reset_disable = false;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7097
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7098
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7099
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7100
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7101
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7102
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7103
/*****************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7104
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7105
 * This function sets the lplu state according to the active flag.  When
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7106
 * activating lplu this function also disables smart speed and vise versa.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7107
 * lplu will not be activated unless the device autonegotiation advertisment
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7108
 * meets standards of either 10 or 10/100 or 10/100/1000 at all duplexes.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7109
 * hw: Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7110
 * active - true to enable lplu false to disable lplu.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7111
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7112
 * returns: - E1000_ERR_PHY if fail to read/write the PHY
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7113
 *            E1000_SUCCESS at any other case.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7114
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7115
 ****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7116
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7117
static s32 e1000_set_d3_lplu_state(struct e1000_hw *hw, bool active)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7118
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7119
    u32 phy_ctrl = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7120
    s32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7121
    u16 phy_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7122
    DEBUGFUNC("e1000_set_d3_lplu_state");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7123
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7124
    if (hw->phy_type != e1000_phy_igp && hw->phy_type != e1000_phy_igp_2
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7125
        && hw->phy_type != e1000_phy_igp_3)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7126
        return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7127
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7128
    /* During driver activity LPLU should not be used or it will attain link
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7129
     * from the lowest speeds starting from 10Mbps. The capability is used for
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7130
     * Dx transitions and states */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7131
    if (hw->mac_type == e1000_82541_rev_2 || hw->mac_type == e1000_82547_rev_2) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7132
        ret_val = e1000_read_phy_reg(hw, IGP01E1000_GMII_FIFO, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7133
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7134
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7135
    } else if (hw->mac_type == e1000_ich8lan) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7136
        /* MAC writes into PHY register based on the state transition
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7137
         * and start auto-negotiation. SW driver can overwrite the settings
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7138
         * in CSR PHY power control E1000_PHY_CTRL register. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7139
        phy_ctrl = er32(PHY_CTRL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7140
    } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7141
        ret_val = e1000_read_phy_reg(hw, IGP02E1000_PHY_POWER_MGMT, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7142
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7143
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7144
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7145
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7146
    if (!active) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7147
        if (hw->mac_type == e1000_82541_rev_2 ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7148
            hw->mac_type == e1000_82547_rev_2) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7149
            phy_data &= ~IGP01E1000_GMII_FLEX_SPD;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7150
            ret_val = e1000_write_phy_reg(hw, IGP01E1000_GMII_FIFO, phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7151
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7152
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7153
        } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7154
            if (hw->mac_type == e1000_ich8lan) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7155
                phy_ctrl &= ~E1000_PHY_CTRL_NOND0A_LPLU;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7156
                ew32(PHY_CTRL, phy_ctrl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7157
            } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7158
                phy_data &= ~IGP02E1000_PM_D3_LPLU;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7159
                ret_val = e1000_write_phy_reg(hw, IGP02E1000_PHY_POWER_MGMT,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7160
                                              phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7161
                if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7162
                    return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7163
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7164
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7165
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7166
        /* LPLU and SmartSpeed are mutually exclusive.  LPLU is used during
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7167
         * Dx states where the power conservation is most important.  During
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7168
         * driver activity we should enable SmartSpeed, so performance is
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7169
         * maintained. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7170
        if (hw->smart_speed == e1000_smart_speed_on) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7171
            ret_val = e1000_read_phy_reg(hw, IGP01E1000_PHY_PORT_CONFIG,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7172
                                         &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7173
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7174
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7175
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7176
            phy_data |= IGP01E1000_PSCFR_SMART_SPEED;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7177
            ret_val = e1000_write_phy_reg(hw, IGP01E1000_PHY_PORT_CONFIG,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7178
                                          phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7179
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7180
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7181
        } else if (hw->smart_speed == e1000_smart_speed_off) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7182
            ret_val = e1000_read_phy_reg(hw, IGP01E1000_PHY_PORT_CONFIG,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7183
                                         &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7184
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7185
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7186
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7187
            phy_data &= ~IGP01E1000_PSCFR_SMART_SPEED;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7188
            ret_val = e1000_write_phy_reg(hw, IGP01E1000_PHY_PORT_CONFIG,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7189
                                          phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7190
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7191
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7192
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7193
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7194
    } else if ((hw->autoneg_advertised == AUTONEG_ADVERTISE_SPEED_DEFAULT) ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7195
               (hw->autoneg_advertised == AUTONEG_ADVERTISE_10_ALL ) ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7196
               (hw->autoneg_advertised == AUTONEG_ADVERTISE_10_100_ALL)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7197
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7198
        if (hw->mac_type == e1000_82541_rev_2 ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7199
            hw->mac_type == e1000_82547_rev_2) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7200
            phy_data |= IGP01E1000_GMII_FLEX_SPD;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7201
            ret_val = e1000_write_phy_reg(hw, IGP01E1000_GMII_FIFO, phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7202
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7203
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7204
        } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7205
            if (hw->mac_type == e1000_ich8lan) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7206
                phy_ctrl |= E1000_PHY_CTRL_NOND0A_LPLU;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7207
                ew32(PHY_CTRL, phy_ctrl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7208
            } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7209
                phy_data |= IGP02E1000_PM_D3_LPLU;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7210
                ret_val = e1000_write_phy_reg(hw, IGP02E1000_PHY_POWER_MGMT,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7211
                                              phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7212
                if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7213
                    return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7214
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7215
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7216
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7217
        /* When LPLU is enabled we should disable SmartSpeed */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7218
        ret_val = e1000_read_phy_reg(hw, IGP01E1000_PHY_PORT_CONFIG, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7219
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7220
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7221
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7222
        phy_data &= ~IGP01E1000_PSCFR_SMART_SPEED;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7223
        ret_val = e1000_write_phy_reg(hw, IGP01E1000_PHY_PORT_CONFIG, phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7224
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7225
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7226
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7227
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7228
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7229
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7230
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7231
/*****************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7232
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7233
 * This function sets the lplu d0 state according to the active flag.  When
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7234
 * activating lplu this function also disables smart speed and vise versa.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7235
 * lplu will not be activated unless the device autonegotiation advertisment
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7236
 * meets standards of either 10 or 10/100 or 10/100/1000 at all duplexes.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7237
 * hw: Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7238
 * active - true to enable lplu false to disable lplu.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7239
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7240
 * returns: - E1000_ERR_PHY if fail to read/write the PHY
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7241
 *            E1000_SUCCESS at any other case.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7242
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7243
 ****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7244
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7245
static s32 e1000_set_d0_lplu_state(struct e1000_hw *hw, bool active)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7246
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7247
    u32 phy_ctrl = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7248
    s32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7249
    u16 phy_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7250
    DEBUGFUNC("e1000_set_d0_lplu_state");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7251
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7252
    if (hw->mac_type <= e1000_82547_rev_2)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7253
        return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7254
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7255
    if (hw->mac_type == e1000_ich8lan) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7256
        phy_ctrl = er32(PHY_CTRL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7257
    } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7258
        ret_val = e1000_read_phy_reg(hw, IGP02E1000_PHY_POWER_MGMT, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7259
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7260
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7261
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7262
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7263
    if (!active) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7264
        if (hw->mac_type == e1000_ich8lan) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7265
            phy_ctrl &= ~E1000_PHY_CTRL_D0A_LPLU;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7266
            ew32(PHY_CTRL, phy_ctrl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7267
        } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7268
            phy_data &= ~IGP02E1000_PM_D0_LPLU;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7269
            ret_val = e1000_write_phy_reg(hw, IGP02E1000_PHY_POWER_MGMT, phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7270
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7271
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7272
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7273
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7274
        /* LPLU and SmartSpeed are mutually exclusive.  LPLU is used during
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7275
         * Dx states where the power conservation is most important.  During
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7276
         * driver activity we should enable SmartSpeed, so performance is
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7277
         * maintained. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7278
        if (hw->smart_speed == e1000_smart_speed_on) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7279
            ret_val = e1000_read_phy_reg(hw, IGP01E1000_PHY_PORT_CONFIG,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7280
                                         &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7281
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7282
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7283
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7284
            phy_data |= IGP01E1000_PSCFR_SMART_SPEED;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7285
            ret_val = e1000_write_phy_reg(hw, IGP01E1000_PHY_PORT_CONFIG,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7286
                                          phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7287
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7288
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7289
        } else if (hw->smart_speed == e1000_smart_speed_off) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7290
            ret_val = e1000_read_phy_reg(hw, IGP01E1000_PHY_PORT_CONFIG,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7291
                                         &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7292
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7293
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7294
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7295
            phy_data &= ~IGP01E1000_PSCFR_SMART_SPEED;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7296
            ret_val = e1000_write_phy_reg(hw, IGP01E1000_PHY_PORT_CONFIG,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7297
                                          phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7298
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7299
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7300
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7301
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7302
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7303
    } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7304
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7305
        if (hw->mac_type == e1000_ich8lan) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7306
            phy_ctrl |= E1000_PHY_CTRL_D0A_LPLU;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7307
            ew32(PHY_CTRL, phy_ctrl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7308
        } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7309
            phy_data |= IGP02E1000_PM_D0_LPLU;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7310
            ret_val = e1000_write_phy_reg(hw, IGP02E1000_PHY_POWER_MGMT, phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7311
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7312
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7313
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7314
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7315
        /* When LPLU is enabled we should disable SmartSpeed */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7316
        ret_val = e1000_read_phy_reg(hw, IGP01E1000_PHY_PORT_CONFIG, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7317
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7318
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7319
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7320
        phy_data &= ~IGP01E1000_PSCFR_SMART_SPEED;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7321
        ret_val = e1000_write_phy_reg(hw, IGP01E1000_PHY_PORT_CONFIG, phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7322
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7323
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7324
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7325
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7326
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7327
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7328
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7329
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7330
 * Change VCO speed register to improve Bit Error Rate performance of SERDES.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7331
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7332
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7333
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7334
static s32 e1000_set_vco_speed(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7335
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7336
    s32  ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7337
    u16 default_page = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7338
    u16 phy_data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7339
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7340
    DEBUGFUNC("e1000_set_vco_speed");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7341
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7342
    switch (hw->mac_type) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7343
    case e1000_82545_rev_3:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7344
    case e1000_82546_rev_3:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7345
       break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7346
    default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7347
        return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7348
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7349
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7350
    /* Set PHY register 30, page 5, bit 8 to 0 */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7351
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7352
    ret_val = e1000_read_phy_reg(hw, M88E1000_PHY_PAGE_SELECT, &default_page);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7353
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7354
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7355
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7356
    ret_val = e1000_write_phy_reg(hw, M88E1000_PHY_PAGE_SELECT, 0x0005);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7357
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7358
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7359
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7360
    ret_val = e1000_read_phy_reg(hw, M88E1000_PHY_GEN_CONTROL, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7361
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7362
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7363
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7364
    phy_data &= ~M88E1000_PHY_VCO_REG_BIT8;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7365
    ret_val = e1000_write_phy_reg(hw, M88E1000_PHY_GEN_CONTROL, phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7366
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7367
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7368
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7369
    /* Set PHY register 30, page 4, bit 11 to 1 */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7370
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7371
    ret_val = e1000_write_phy_reg(hw, M88E1000_PHY_PAGE_SELECT, 0x0004);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7372
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7373
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7374
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7375
    ret_val = e1000_read_phy_reg(hw, M88E1000_PHY_GEN_CONTROL, &phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7376
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7377
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7378
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7379
    phy_data |= M88E1000_PHY_VCO_REG_BIT11;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7380
    ret_val = e1000_write_phy_reg(hw, M88E1000_PHY_GEN_CONTROL, phy_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7381
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7382
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7383
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7384
    ret_val = e1000_write_phy_reg(hw, M88E1000_PHY_PAGE_SELECT, default_page);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7385
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7386
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7387
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7388
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7389
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7390
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7391
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7392
/*****************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7393
 * This function reads the cookie from ARC ram.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7394
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7395
 * returns: - E1000_SUCCESS .
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7396
 ****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7397
static s32 e1000_host_if_read_cookie(struct e1000_hw *hw, u8 *buffer)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7398
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7399
    u8 i;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7400
    u32 offset = E1000_MNG_DHCP_COOKIE_OFFSET;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7401
    u8 length = E1000_MNG_DHCP_COOKIE_LENGTH;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7402
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7403
    length = (length >> 2);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7404
    offset = (offset >> 2);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7405
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7406
    for (i = 0; i < length; i++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7407
        *((u32 *)buffer + i) =
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7408
            E1000_READ_REG_ARRAY_DWORD(hw, HOST_IF, offset + i);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7409
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7410
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7411
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7412
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7413
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7414
/*****************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7415
 * This function checks whether the HOST IF is enabled for command operaton
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7416
 * and also checks whether the previous command is completed.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7417
 * It busy waits in case of previous command is not completed.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7418
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7419
 * returns: - E1000_ERR_HOST_INTERFACE_COMMAND in case if is not ready or
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7420
 *            timeout
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7421
 *          - E1000_SUCCESS for success.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7422
 ****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7423
static s32 e1000_mng_enable_host_if(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7424
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7425
    u32 hicr;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7426
    u8 i;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7427
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7428
    /* Check that the host interface is enabled. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7429
    hicr = er32(HICR);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7430
    if ((hicr & E1000_HICR_EN) == 0) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7431
        DEBUGOUT("E1000_HOST_EN bit disabled.\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7432
        return -E1000_ERR_HOST_INTERFACE_COMMAND;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7433
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7434
    /* check the previous command is completed */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7435
    for (i = 0; i < E1000_MNG_DHCP_COMMAND_TIMEOUT; i++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7436
        hicr = er32(HICR);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7437
        if (!(hicr & E1000_HICR_C))
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7438
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7439
        mdelay(1);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7440
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7441
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7442
    if (i == E1000_MNG_DHCP_COMMAND_TIMEOUT) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7443
        DEBUGOUT("Previous command timeout failed .\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7444
        return -E1000_ERR_HOST_INTERFACE_COMMAND;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7445
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7446
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7447
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7448
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7449
/*****************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7450
 * This function writes the buffer content at the offset given on the host if.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7451
 * It also does alignment considerations to do the writes in most efficient way.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7452
 * Also fills up the sum of the buffer in *buffer parameter.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7453
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7454
 * returns  - E1000_SUCCESS for success.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7455
 ****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7456
static s32 e1000_mng_host_if_write(struct e1000_hw *hw, u8 *buffer, u16 length,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7457
				   u16 offset, u8 *sum)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7458
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7459
    u8 *tmp;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7460
    u8 *bufptr = buffer;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7461
    u32 data = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7462
    u16 remaining, i, j, prev_bytes;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7463
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7464
    /* sum = only sum of the data and it is not checksum */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7465
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7466
    if (length == 0 || offset + length > E1000_HI_MAX_MNG_DATA_LENGTH) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7467
        return -E1000_ERR_PARAM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7468
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7469
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7470
    tmp = (u8 *)&data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7471
    prev_bytes = offset & 0x3;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7472
    offset &= 0xFFFC;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7473
    offset >>= 2;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7474
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7475
    if (prev_bytes) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7476
        data = E1000_READ_REG_ARRAY_DWORD(hw, HOST_IF, offset);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7477
        for (j = prev_bytes; j < sizeof(u32); j++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7478
            *(tmp + j) = *bufptr++;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7479
            *sum += *(tmp + j);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7480
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7481
        E1000_WRITE_REG_ARRAY_DWORD(hw, HOST_IF, offset, data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7482
        length -= j - prev_bytes;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7483
        offset++;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7484
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7485
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7486
    remaining = length & 0x3;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7487
    length -= remaining;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7488
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7489
    /* Calculate length in DWORDs */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7490
    length >>= 2;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7491
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7492
    /* The device driver writes the relevant command block into the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7493
     * ram area. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7494
    for (i = 0; i < length; i++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7495
        for (j = 0; j < sizeof(u32); j++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7496
            *(tmp + j) = *bufptr++;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7497
            *sum += *(tmp + j);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7498
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7499
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7500
        E1000_WRITE_REG_ARRAY_DWORD(hw, HOST_IF, offset + i, data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7501
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7502
    if (remaining) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7503
        for (j = 0; j < sizeof(u32); j++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7504
            if (j < remaining)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7505
                *(tmp + j) = *bufptr++;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7506
            else
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7507
                *(tmp + j) = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7508
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7509
            *sum += *(tmp + j);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7510
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7511
        E1000_WRITE_REG_ARRAY_DWORD(hw, HOST_IF, offset + i, data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7512
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7513
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7514
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7515
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7516
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7517
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7518
/*****************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7519
 * This function writes the command header after does the checksum calculation.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7520
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7521
 * returns  - E1000_SUCCESS for success.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7522
 ****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7523
static s32 e1000_mng_write_cmd_header(struct e1000_hw *hw,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7524
				      struct e1000_host_mng_command_header *hdr)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7525
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7526
    u16 i;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7527
    u8 sum;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7528
    u8 *buffer;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7529
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7530
    /* Write the whole command header structure which includes sum of
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7531
     * the buffer */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7532
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7533
    u16 length = sizeof(struct e1000_host_mng_command_header);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7534
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7535
    sum = hdr->checksum;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7536
    hdr->checksum = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7537
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7538
    buffer = (u8 *)hdr;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7539
    i = length;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7540
    while (i--)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7541
        sum += buffer[i];
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7542
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7543
    hdr->checksum = 0 - sum;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7544
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7545
    length >>= 2;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7546
    /* The device driver writes the relevant command block into the ram area. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7547
    for (i = 0; i < length; i++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7548
        E1000_WRITE_REG_ARRAY_DWORD(hw, HOST_IF, i, *((u32 *)hdr + i));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7549
        E1000_WRITE_FLUSH();
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7550
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7551
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7552
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7553
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7554
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7555
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7556
/*****************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7557
 * This function indicates to ARC that a new command is pending which completes
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7558
 * one write operation by the driver.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7559
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7560
 * returns  - E1000_SUCCESS for success.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7561
 ****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7562
static s32 e1000_mng_write_commit(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7563
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7564
    u32 hicr;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7565
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7566
    hicr = er32(HICR);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7567
    /* Setting this bit tells the ARC that a new command is pending. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7568
    ew32(HICR, hicr | E1000_HICR_C);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7569
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7570
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7571
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7572
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7573
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7574
/*****************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7575
 * This function checks the mode of the firmware.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7576
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7577
 * returns  - true when the mode is IAMT or false.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7578
 ****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7579
bool e1000_check_mng_mode(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7580
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7581
    u32 fwsm;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7582
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7583
    fwsm = er32(FWSM);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7584
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7585
    if (hw->mac_type == e1000_ich8lan) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7586
        if ((fwsm & E1000_FWSM_MODE_MASK) ==
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7587
            (E1000_MNG_ICH_IAMT_MODE << E1000_FWSM_MODE_SHIFT))
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7588
            return true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7589
    } else if ((fwsm & E1000_FWSM_MODE_MASK) ==
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7590
               (E1000_MNG_IAMT_MODE << E1000_FWSM_MODE_SHIFT))
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7591
        return true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7592
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7593
    return false;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7594
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7595
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7596
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7597
/*****************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7598
 * This function writes the dhcp info .
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7599
 ****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7600
s32 e1000_mng_write_dhcp_info(struct e1000_hw *hw, u8 *buffer, u16 length)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7601
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7602
    s32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7603
    struct e1000_host_mng_command_header hdr;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7604
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7605
    hdr.command_id = E1000_MNG_DHCP_TX_PAYLOAD_CMD;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7606
    hdr.command_length = length;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7607
    hdr.reserved1 = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7608
    hdr.reserved2 = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7609
    hdr.checksum = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7610
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7611
    ret_val = e1000_mng_enable_host_if(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7612
    if (ret_val == E1000_SUCCESS) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7613
        ret_val = e1000_mng_host_if_write(hw, buffer, length, sizeof(hdr),
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7614
                                          &(hdr.checksum));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7615
        if (ret_val == E1000_SUCCESS) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7616
            ret_val = e1000_mng_write_cmd_header(hw, &hdr);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7617
            if (ret_val == E1000_SUCCESS)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7618
                ret_val = e1000_mng_write_commit(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7619
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7620
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7621
    return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7622
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7623
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7624
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7625
/*****************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7626
 * This function calculates the checksum.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7627
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7628
 * returns  - checksum of buffer contents.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7629
 ****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7630
static u8 e1000_calculate_mng_checksum(char *buffer, u32 length)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7631
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7632
    u8 sum = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7633
    u32 i;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7634
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7635
    if (!buffer)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7636
        return 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7637
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7638
    for (i=0; i < length; i++)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7639
        sum += buffer[i];
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7640
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7641
    return (u8)(0 - sum);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7642
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7643
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7644
/*****************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7645
 * This function checks whether tx pkt filtering needs to be enabled or not.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7646
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7647
 * returns  - true for packet filtering or false.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7648
 ****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7649
bool e1000_enable_tx_pkt_filtering(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7650
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7651
    /* called in init as well as watchdog timer functions */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7652
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7653
    s32 ret_val, checksum;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7654
    bool tx_filter = false;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7655
    struct e1000_host_mng_dhcp_cookie *hdr = &(hw->mng_cookie);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7656
    u8 *buffer = (u8 *) &(hw->mng_cookie);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7657
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7658
    if (e1000_check_mng_mode(hw)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7659
        ret_val = e1000_mng_enable_host_if(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7660
        if (ret_val == E1000_SUCCESS) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7661
            ret_val = e1000_host_if_read_cookie(hw, buffer);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7662
            if (ret_val == E1000_SUCCESS) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7663
                checksum = hdr->checksum;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7664
                hdr->checksum = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7665
                if ((hdr->signature == E1000_IAMT_SIGNATURE) &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7666
                    checksum == e1000_calculate_mng_checksum((char *)buffer,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7667
                                               E1000_MNG_DHCP_COOKIE_LENGTH)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7668
                    if (hdr->status &
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7669
                        E1000_MNG_DHCP_COOKIE_STATUS_PARSING_SUPPORT)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7670
                        tx_filter = true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7671
                } else
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7672
                    tx_filter = true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7673
            } else
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7674
                tx_filter = true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7675
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7676
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7677
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7678
    hw->tx_pkt_filtering = tx_filter;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7679
    return tx_filter;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7680
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7681
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7682
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7683
 * Verifies the hardware needs to allow ARPs to be processed by the host
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7684
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7685
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7686
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7687
 * returns: - true/false
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7688
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7689
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7690
u32 e1000_enable_mng_pass_thru(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7691
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7692
    u32 manc;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7693
    u32 fwsm, factps;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7694
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7695
    if (hw->asf_firmware_present) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7696
        manc = er32(MANC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7697
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7698
        if (!(manc & E1000_MANC_RCV_TCO_EN) ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7699
            !(manc & E1000_MANC_EN_MAC_ADDR_FILTER))
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7700
            return false;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7701
        if (e1000_arc_subsystem_valid(hw)) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7702
            fwsm = er32(FWSM);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7703
            factps = er32(FACTPS);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7704
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7705
            if ((((fwsm & E1000_FWSM_MODE_MASK) >> E1000_FWSM_MODE_SHIFT) ==
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7706
                   e1000_mng_mode_pt) && !(factps & E1000_FACTPS_MNGCG))
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7707
                return true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7708
        } else
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7709
            if ((manc & E1000_MANC_SMBUS_EN) && !(manc & E1000_MANC_ASF_EN))
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7710
                return true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7711
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7712
    return false;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7713
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7714
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7715
static s32 e1000_polarity_reversal_workaround(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7716
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7717
    s32 ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7718
    u16 mii_status_reg;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7719
    u16 i;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7720
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7721
    /* Polarity reversal workaround for forced 10F/10H links. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7722
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7723
    /* Disable the transmitter on the PHY */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7724
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7725
    ret_val = e1000_write_phy_reg(hw, M88E1000_PHY_PAGE_SELECT, 0x0019);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7726
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7727
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7728
    ret_val = e1000_write_phy_reg(hw, M88E1000_PHY_GEN_CONTROL, 0xFFFF);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7729
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7730
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7731
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7732
    ret_val = e1000_write_phy_reg(hw, M88E1000_PHY_PAGE_SELECT, 0x0000);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7733
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7734
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7735
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7736
    /* This loop will early-out if the NO link condition has been met. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7737
    for (i = PHY_FORCE_TIME; i > 0; i--) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7738
        /* Read the MII Status Register and wait for Link Status bit
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7739
         * to be clear.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7740
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7741
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7742
        ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &mii_status_reg);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7743
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7744
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7745
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7746
        ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &mii_status_reg);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7747
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7748
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7749
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7750
        if ((mii_status_reg & ~MII_SR_LINK_STATUS) == 0) break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7751
        mdelay(100);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7752
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7753
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7754
    /* Recommended delay time after link has been lost */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7755
    mdelay(1000);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7756
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7757
    /* Now we will re-enable th transmitter on the PHY */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7758
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7759
    ret_val = e1000_write_phy_reg(hw, M88E1000_PHY_PAGE_SELECT, 0x0019);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7760
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7761
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7762
    mdelay(50);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7763
    ret_val = e1000_write_phy_reg(hw, M88E1000_PHY_GEN_CONTROL, 0xFFF0);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7764
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7765
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7766
    mdelay(50);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7767
    ret_val = e1000_write_phy_reg(hw, M88E1000_PHY_GEN_CONTROL, 0xFF00);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7768
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7769
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7770
    mdelay(50);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7771
    ret_val = e1000_write_phy_reg(hw, M88E1000_PHY_GEN_CONTROL, 0x0000);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7772
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7773
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7774
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7775
    ret_val = e1000_write_phy_reg(hw, M88E1000_PHY_PAGE_SELECT, 0x0000);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7776
    if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7777
        return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7778
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7779
    /* This loop will early-out if the link condition has been met. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7780
    for (i = PHY_FORCE_TIME; i > 0; i--) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7781
        /* Read the MII Status Register and wait for Link Status bit
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7782
         * to be set.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7783
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7784
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7785
        ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &mii_status_reg);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7786
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7787
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7788
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7789
        ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &mii_status_reg);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7790
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7791
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7792
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7793
        if (mii_status_reg & MII_SR_LINK_STATUS) break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7794
        mdelay(100);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7795
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7796
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7797
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7798
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7799
/***************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7800
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7801
 * Disables PCI-Express master access.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7802
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7803
 * hw: Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7804
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7805
 * returns: - none.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7806
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7807
 ***************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7808
static void e1000_set_pci_express_master_disable(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7809
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7810
    u32 ctrl;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7811
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7812
    DEBUGFUNC("e1000_set_pci_express_master_disable");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7813
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7814
    if (hw->bus_type != e1000_bus_type_pci_express)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7815
        return;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7816
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7817
    ctrl = er32(CTRL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7818
    ctrl |= E1000_CTRL_GIO_MASTER_DISABLE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7819
    ew32(CTRL, ctrl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7820
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7821
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7822
/*******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7823
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7824
 * Disables PCI-Express master access and verifies there are no pending requests
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7825
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7826
 * hw: Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7827
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7828
 * returns: - E1000_ERR_MASTER_REQUESTS_PENDING if master disable bit hasn't
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7829
 *            caused the master requests to be disabled.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7830
 *            E1000_SUCCESS master requests disabled.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7831
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7832
 ******************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7833
s32 e1000_disable_pciex_master(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7834
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7835
    s32 timeout = MASTER_DISABLE_TIMEOUT;   /* 80ms */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7836
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7837
    DEBUGFUNC("e1000_disable_pciex_master");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7838
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7839
    if (hw->bus_type != e1000_bus_type_pci_express)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7840
        return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7841
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7842
    e1000_set_pci_express_master_disable(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7843
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7844
    while (timeout) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7845
        if (!(er32(STATUS) & E1000_STATUS_GIO_MASTER_ENABLE))
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7846
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7847
        else
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7848
            udelay(100);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7849
        timeout--;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7850
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7851
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7852
    if (!timeout) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7853
        DEBUGOUT("Master requests are pending.\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7854
        return -E1000_ERR_MASTER_REQUESTS_PENDING;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7855
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7856
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7857
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7858
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7859
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7860
/*******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7861
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7862
 * Check for EEPROM Auto Read bit done.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7863
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7864
 * hw: Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7865
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7866
 * returns: - E1000_ERR_RESET if fail to reset MAC
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7867
 *            E1000_SUCCESS at any other case.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7868
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7869
 ******************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7870
static s32 e1000_get_auto_rd_done(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7871
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7872
    s32 timeout = AUTO_READ_DONE_TIMEOUT;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7873
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7874
    DEBUGFUNC("e1000_get_auto_rd_done");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7875
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7876
    switch (hw->mac_type) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7877
    default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7878
        msleep(5);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7879
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7880
    case e1000_82571:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7881
    case e1000_82572:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7882
    case e1000_82573:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7883
    case e1000_80003es2lan:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7884
    case e1000_ich8lan:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7885
        while (timeout) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7886
            if (er32(EECD) & E1000_EECD_AUTO_RD)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7887
                break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7888
            else msleep(1);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7889
            timeout--;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7890
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7891
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7892
        if (!timeout) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7893
            DEBUGOUT("Auto read by HW from EEPROM has not completed.\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7894
            return -E1000_ERR_RESET;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7895
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7896
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7897
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7898
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7899
    /* PHY configuration from NVM just starts after EECD_AUTO_RD sets to high.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7900
     * Need to wait for PHY configuration completion before accessing NVM
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7901
     * and PHY. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7902
    if (hw->mac_type == e1000_82573)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7903
        msleep(25);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7904
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7905
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7906
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7907
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7908
/***************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7909
 * Checks if the PHY configuration is done
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7910
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7911
 * hw: Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7912
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7913
 * returns: - E1000_ERR_RESET if fail to reset MAC
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7914
 *            E1000_SUCCESS at any other case.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7915
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7916
 ***************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7917
static s32 e1000_get_phy_cfg_done(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7918
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7919
    s32 timeout = PHY_CFG_TIMEOUT;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7920
    u32 cfg_mask = E1000_EEPROM_CFG_DONE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7921
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7922
    DEBUGFUNC("e1000_get_phy_cfg_done");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7923
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7924
    switch (hw->mac_type) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7925
    default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7926
        mdelay(10);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7927
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7928
    case e1000_80003es2lan:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7929
        /* Separate *_CFG_DONE_* bit for each port */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7930
        if (er32(STATUS) & E1000_STATUS_FUNC_1)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7931
            cfg_mask = E1000_EEPROM_CFG_DONE_PORT_1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7932
        /* Fall Through */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7933
    case e1000_82571:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7934
    case e1000_82572:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7935
        while (timeout) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7936
            if (er32(EEMNGCTL) & cfg_mask)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7937
                break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7938
            else
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7939
                msleep(1);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7940
            timeout--;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7941
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7942
        if (!timeout) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7943
            DEBUGOUT("MNG configuration cycle has not completed.\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7944
            return -E1000_ERR_RESET;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7945
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7946
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7947
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7948
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7949
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7950
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7951
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7952
/***************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7953
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7954
 * Using the combination of SMBI and SWESMBI semaphore bits when resetting
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7955
 * adapter or Eeprom access.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7956
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7957
 * hw: Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7958
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7959
 * returns: - E1000_ERR_EEPROM if fail to access EEPROM.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7960
 *            E1000_SUCCESS at any other case.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7961
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7962
 ***************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7963
static s32 e1000_get_hw_eeprom_semaphore(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7964
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7965
    s32 timeout;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7966
    u32 swsm;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7967
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7968
    DEBUGFUNC("e1000_get_hw_eeprom_semaphore");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7969
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7970
    if (!hw->eeprom_semaphore_present)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7971
        return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7972
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7973
    if (hw->mac_type == e1000_80003es2lan) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7974
        /* Get the SW semaphore. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7975
        if (e1000_get_software_semaphore(hw) != E1000_SUCCESS)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7976
            return -E1000_ERR_EEPROM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7977
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7978
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7979
    /* Get the FW semaphore. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7980
    timeout = hw->eeprom.word_size + 1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7981
    while (timeout) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7982
        swsm = er32(SWSM);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7983
        swsm |= E1000_SWSM_SWESMBI;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7984
        ew32(SWSM, swsm);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7985
        /* if we managed to set the bit we got the semaphore. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7986
        swsm = er32(SWSM);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7987
        if (swsm & E1000_SWSM_SWESMBI)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7988
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7989
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7990
        udelay(50);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7991
        timeout--;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7992
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7993
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7994
    if (!timeout) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7995
        /* Release semaphores */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7996
        e1000_put_hw_eeprom_semaphore(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7997
        DEBUGOUT("Driver can't access the Eeprom - SWESMBI bit is set.\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7998
        return -E1000_ERR_EEPROM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  7999
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8000
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8001
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8002
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8003
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8004
/***************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8005
 * This function clears HW semaphore bits.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8006
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8007
 * hw: Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8008
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8009
 * returns: - None.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8010
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8011
 ***************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8012
static void e1000_put_hw_eeprom_semaphore(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8013
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8014
    u32 swsm;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8015
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8016
    DEBUGFUNC("e1000_put_hw_eeprom_semaphore");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8017
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8018
    if (!hw->eeprom_semaphore_present)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8019
        return;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8020
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8021
    swsm = er32(SWSM);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8022
    if (hw->mac_type == e1000_80003es2lan) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8023
        /* Release both semaphores. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8024
        swsm &= ~(E1000_SWSM_SMBI | E1000_SWSM_SWESMBI);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8025
    } else
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8026
        swsm &= ~(E1000_SWSM_SWESMBI);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8027
    ew32(SWSM, swsm);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8028
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8029
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8030
/***************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8031
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8032
 * Obtaining software semaphore bit (SMBI) before resetting PHY.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8033
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8034
 * hw: Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8035
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8036
 * returns: - E1000_ERR_RESET if fail to obtain semaphore.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8037
 *            E1000_SUCCESS at any other case.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8038
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8039
 ***************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8040
static s32 e1000_get_software_semaphore(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8041
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8042
    s32 timeout = hw->eeprom.word_size + 1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8043
    u32 swsm;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8044
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8045
    DEBUGFUNC("e1000_get_software_semaphore");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8046
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8047
    if (hw->mac_type != e1000_80003es2lan) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8048
        return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8049
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8050
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8051
    while (timeout) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8052
        swsm = er32(SWSM);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8053
        /* If SMBI bit cleared, it is now set and we hold the semaphore */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8054
        if (!(swsm & E1000_SWSM_SMBI))
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8055
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8056
        mdelay(1);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8057
        timeout--;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8058
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8059
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8060
    if (!timeout) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8061
        DEBUGOUT("Driver can't access device - SMBI bit is set.\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8062
        return -E1000_ERR_RESET;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8063
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8064
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8065
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8066
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8067
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8068
/***************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8069
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8070
 * Release semaphore bit (SMBI).
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8071
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8072
 * hw: Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8073
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8074
 ***************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8075
static void e1000_release_software_semaphore(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8076
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8077
    u32 swsm;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8078
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8079
    DEBUGFUNC("e1000_release_software_semaphore");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8080
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8081
    if (hw->mac_type != e1000_80003es2lan) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8082
        return;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8083
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8084
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8085
    swsm = er32(SWSM);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8086
    /* Release the SW semaphores.*/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8087
    swsm &= ~E1000_SWSM_SMBI;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8088
    ew32(SWSM, swsm);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8089
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8090
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8091
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8092
 * Checks if PHY reset is blocked due to SOL/IDER session, for example.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8093
 * Returning E1000_BLK_PHY_RESET isn't necessarily an error.  But it's up to
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8094
 * the caller to figure out how to deal with it.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8095
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8096
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8097
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8098
 * returns: - E1000_BLK_PHY_RESET
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8099
 *            E1000_SUCCESS
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8100
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8101
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8102
s32 e1000_check_phy_reset_block(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8103
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8104
    u32 manc = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8105
    u32 fwsm = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8106
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8107
    if (hw->mac_type == e1000_ich8lan) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8108
        fwsm = er32(FWSM);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8109
        return (fwsm & E1000_FWSM_RSPCIPHY) ? E1000_SUCCESS
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8110
                                            : E1000_BLK_PHY_RESET;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8111
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8112
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8113
    if (hw->mac_type > e1000_82547_rev_2)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8114
        manc = er32(MANC);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8115
    return (manc & E1000_MANC_BLK_PHY_RST_ON_IDE) ?
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8116
        E1000_BLK_PHY_RESET : E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8117
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8118
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8119
static u8 e1000_arc_subsystem_valid(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8120
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8121
    u32 fwsm;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8122
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8123
    /* On 8257x silicon, registers in the range of 0x8800 - 0x8FFC
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8124
     * may not be provided a DMA clock when no manageability features are
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8125
     * enabled.  We do not want to perform any reads/writes to these registers
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8126
     * if this is the case.  We read FWSM to determine the manageability mode.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8127
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8128
    switch (hw->mac_type) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8129
    case e1000_82571:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8130
    case e1000_82572:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8131
    case e1000_82573:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8132
    case e1000_80003es2lan:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8133
        fwsm = er32(FWSM);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8134
        if ((fwsm & E1000_FWSM_MODE_MASK) != 0)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8135
            return true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8136
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8137
    case e1000_ich8lan:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8138
        return true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8139
    default:
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8140
        break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8141
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8142
    return false;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8143
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8144
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8145
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8146
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8147
 * Configure PCI-Ex no-snoop
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8148
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8149
 * hw - Struct containing variables accessed by shared code.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8150
 * no_snoop - Bitmap of no-snoop events.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8151
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8152
 * returns: E1000_SUCCESS
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8153
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8154
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8155
static s32 e1000_set_pci_ex_no_snoop(struct e1000_hw *hw, u32 no_snoop)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8156
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8157
    u32 gcr_reg = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8158
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8159
    DEBUGFUNC("e1000_set_pci_ex_no_snoop");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8160
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8161
    if (hw->bus_type == e1000_bus_type_unknown)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8162
        e1000_get_bus_info(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8163
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8164
    if (hw->bus_type != e1000_bus_type_pci_express)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8165
        return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8166
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8167
    if (no_snoop) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8168
        gcr_reg = er32(GCR);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8169
        gcr_reg &= ~(PCI_EX_NO_SNOOP_ALL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8170
        gcr_reg |= no_snoop;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8171
        ew32(GCR, gcr_reg);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8172
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8173
    if (hw->mac_type == e1000_ich8lan) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8174
        u32 ctrl_ext;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8175
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8176
        ew32(GCR, PCI_EX_82566_SNOOP_ALL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8177
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8178
        ctrl_ext = er32(CTRL_EXT);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8179
        ctrl_ext |= E1000_CTRL_EXT_RO_DIS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8180
        ew32(CTRL_EXT, ctrl_ext);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8181
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8182
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8183
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8184
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8185
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8186
/***************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8187
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8188
 * Get software semaphore FLAG bit (SWFLAG).
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8189
 * SWFLAG is used to synchronize the access to all shared resource between
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8190
 * SW, FW and HW.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8191
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8192
 * hw: Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8193
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8194
 ***************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8195
static s32 e1000_get_software_flag(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8196
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8197
    s32 timeout = PHY_CFG_TIMEOUT;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8198
    u32 extcnf_ctrl;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8199
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8200
    DEBUGFUNC("e1000_get_software_flag");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8201
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8202
    if (hw->mac_type == e1000_ich8lan) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8203
        while (timeout) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8204
            extcnf_ctrl = er32(EXTCNF_CTRL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8205
            extcnf_ctrl |= E1000_EXTCNF_CTRL_SWFLAG;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8206
            ew32(EXTCNF_CTRL, extcnf_ctrl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8207
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8208
            extcnf_ctrl = er32(EXTCNF_CTRL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8209
            if (extcnf_ctrl & E1000_EXTCNF_CTRL_SWFLAG)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8210
                break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8211
            mdelay(1);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8212
            timeout--;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8213
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8214
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8215
        if (!timeout) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8216
            DEBUGOUT("FW or HW locks the resource too long.\n");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8217
            return -E1000_ERR_CONFIG;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8218
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8219
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8220
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8221
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8222
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8223
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8224
/***************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8225
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8226
 * Release software semaphore FLAG bit (SWFLAG).
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8227
 * SWFLAG is used to synchronize the access to all shared resource between
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8228
 * SW, FW and HW.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8229
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8230
 * hw: Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8231
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8232
 ***************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8233
static void e1000_release_software_flag(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8234
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8235
    u32 extcnf_ctrl;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8236
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8237
    DEBUGFUNC("e1000_release_software_flag");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8238
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8239
    if (hw->mac_type == e1000_ich8lan) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8240
        extcnf_ctrl= er32(EXTCNF_CTRL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8241
        extcnf_ctrl &= ~E1000_EXTCNF_CTRL_SWFLAG;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8242
        ew32(EXTCNF_CTRL, extcnf_ctrl);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8243
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8244
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8245
    return;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8246
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8247
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8248
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8249
 * Reads a 16 bit word or words from the EEPROM using the ICH8's flash access
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8250
 * register.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8251
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8252
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8253
 * offset - offset of word in the EEPROM to read
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8254
 * data - word read from the EEPROM
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8255
 * words - number of words to read
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8256
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8257
static s32 e1000_read_eeprom_ich8(struct e1000_hw *hw, u16 offset, u16 words,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8258
				  u16 *data)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8259
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8260
    s32  error = E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8261
    u32 flash_bank = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8262
    u32 act_offset = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8263
    u32 bank_offset = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8264
    u16 word = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8265
    u16 i = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8266
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8267
    /* We need to know which is the valid flash bank.  In the event
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8268
     * that we didn't allocate eeprom_shadow_ram, we may not be
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8269
     * managing flash_bank.  So it cannot be trusted and needs
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8270
     * to be updated with each read.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8271
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8272
    /* Value of bit 22 corresponds to the flash bank we're on. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8273
    flash_bank = (er32(EECD) & E1000_EECD_SEC1VAL) ? 1 : 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8274
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8275
    /* Adjust offset appropriately if we're on bank 1 - adjust for word size */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8276
    bank_offset = flash_bank * (hw->flash_bank_size * 2);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8277
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8278
    error = e1000_get_software_flag(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8279
    if (error != E1000_SUCCESS)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8280
        return error;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8281
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8282
    for (i = 0; i < words; i++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8283
        if (hw->eeprom_shadow_ram != NULL &&
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8284
            hw->eeprom_shadow_ram[offset+i].modified) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8285
            data[i] = hw->eeprom_shadow_ram[offset+i].eeprom_word;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8286
        } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8287
            /* The NVM part needs a byte offset, hence * 2 */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8288
            act_offset = bank_offset + ((offset + i) * 2);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8289
            error = e1000_read_ich8_word(hw, act_offset, &word);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8290
            if (error != E1000_SUCCESS)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8291
                break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8292
            data[i] = word;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8293
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8294
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8295
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8296
    e1000_release_software_flag(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8297
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8298
    return error;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8299
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8300
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8301
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8302
 * Writes a 16 bit word or words to the EEPROM using the ICH8's flash access
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8303
 * register.  Actually, writes are written to the shadow ram cache in the hw
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8304
 * structure hw->e1000_shadow_ram.  e1000_commit_shadow_ram flushes this to
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8305
 * the NVM, which occurs when the NVM checksum is updated.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8306
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8307
 * hw - Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8308
 * offset - offset of word in the EEPROM to write
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8309
 * words - number of words to write
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8310
 * data - words to write to the EEPROM
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8311
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8312
static s32 e1000_write_eeprom_ich8(struct e1000_hw *hw, u16 offset, u16 words,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8313
				   u16 *data)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8314
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8315
    u32 i = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8316
    s32 error = E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8317
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8318
    error = e1000_get_software_flag(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8319
    if (error != E1000_SUCCESS)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8320
        return error;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8321
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8322
    /* A driver can write to the NVM only if it has eeprom_shadow_ram
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8323
     * allocated.  Subsequent reads to the modified words are read from
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8324
     * this cached structure as well.  Writes will only go into this
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8325
     * cached structure unless it's followed by a call to
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8326
     * e1000_update_eeprom_checksum() where it will commit the changes
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8327
     * and clear the "modified" field.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8328
     */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8329
    if (hw->eeprom_shadow_ram != NULL) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8330
        for (i = 0; i < words; i++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8331
            if ((offset + i) < E1000_SHADOW_RAM_WORDS) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8332
                hw->eeprom_shadow_ram[offset+i].modified = true;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8333
                hw->eeprom_shadow_ram[offset+i].eeprom_word = data[i];
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8334
            } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8335
                error = -E1000_ERR_EEPROM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8336
                break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8337
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8338
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8339
    } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8340
        /* Drivers have the option to not allocate eeprom_shadow_ram as long
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8341
         * as they don't perform any NVM writes.  An attempt in doing so
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8342
         * will result in this error.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8343
         */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8344
        error = -E1000_ERR_EEPROM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8345
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8346
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8347
    e1000_release_software_flag(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8348
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8349
    return error;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8350
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8351
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8352
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8353
 * This function does initial flash setup so that a new read/write/erase cycle
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8354
 * can be started.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8355
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8356
 * hw - The pointer to the hw structure
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8357
 ****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8358
static s32 e1000_ich8_cycle_init(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8359
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8360
    union ich8_hws_flash_status hsfsts;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8361
    s32 error = E1000_ERR_EEPROM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8362
    s32 i     = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8363
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8364
    DEBUGFUNC("e1000_ich8_cycle_init");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8365
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8366
    hsfsts.regval = E1000_READ_ICH_FLASH_REG16(hw, ICH_FLASH_HSFSTS);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8367
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8368
    /* May be check the Flash Des Valid bit in Hw status */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8369
    if (hsfsts.hsf_status.fldesvalid == 0) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8370
        DEBUGOUT("Flash descriptor invalid.  SW Sequencing must be used.");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8371
        return error;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8372
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8373
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8374
    /* Clear FCERR in Hw status by writing 1 */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8375
    /* Clear DAEL in Hw status by writing a 1 */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8376
    hsfsts.hsf_status.flcerr = 1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8377
    hsfsts.hsf_status.dael = 1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8378
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8379
    E1000_WRITE_ICH_FLASH_REG16(hw, ICH_FLASH_HSFSTS, hsfsts.regval);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8380
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8381
    /* Either we should have a hardware SPI cycle in progress bit to check
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8382
     * against, in order to start a new cycle or FDONE bit should be changed
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8383
     * in the hardware so that it is 1 after harware reset, which can then be
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8384
     * used as an indication whether a cycle is in progress or has been
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8385
     * completed .. we should also have some software semaphore mechanism to
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8386
     * guard FDONE or the cycle in progress bit so that two threads access to
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8387
     * those bits can be sequentiallized or a way so that 2 threads dont
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8388
     * start the cycle at the same time */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8389
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8390
    if (hsfsts.hsf_status.flcinprog == 0) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8391
        /* There is no cycle running at present, so we can start a cycle */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8392
        /* Begin by setting Flash Cycle Done. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8393
        hsfsts.hsf_status.flcdone = 1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8394
        E1000_WRITE_ICH_FLASH_REG16(hw, ICH_FLASH_HSFSTS, hsfsts.regval);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8395
        error = E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8396
    } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8397
        /* otherwise poll for sometime so the current cycle has a chance
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8398
         * to end before giving up. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8399
        for (i = 0; i < ICH_FLASH_COMMAND_TIMEOUT; i++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8400
            hsfsts.regval = E1000_READ_ICH_FLASH_REG16(hw, ICH_FLASH_HSFSTS);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8401
            if (hsfsts.hsf_status.flcinprog == 0) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8402
                error = E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8403
                break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8404
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8405
            udelay(1);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8406
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8407
        if (error == E1000_SUCCESS) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8408
            /* Successful in waiting for previous cycle to timeout,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8409
             * now set the Flash Cycle Done. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8410
            hsfsts.hsf_status.flcdone = 1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8411
            E1000_WRITE_ICH_FLASH_REG16(hw, ICH_FLASH_HSFSTS, hsfsts.regval);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8412
        } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8413
            DEBUGOUT("Flash controller busy, cannot get access");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8414
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8415
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8416
    return error;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8417
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8418
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8419
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8420
 * This function starts a flash cycle and waits for its completion
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8421
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8422
 * hw - The pointer to the hw structure
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8423
 ****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8424
static s32 e1000_ich8_flash_cycle(struct e1000_hw *hw, u32 timeout)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8425
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8426
    union ich8_hws_flash_ctrl hsflctl;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8427
    union ich8_hws_flash_status hsfsts;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8428
    s32 error = E1000_ERR_EEPROM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8429
    u32 i = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8430
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8431
    /* Start a cycle by writing 1 in Flash Cycle Go in Hw Flash Control */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8432
    hsflctl.regval = E1000_READ_ICH_FLASH_REG16(hw, ICH_FLASH_HSFCTL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8433
    hsflctl.hsf_ctrl.flcgo = 1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8434
    E1000_WRITE_ICH_FLASH_REG16(hw, ICH_FLASH_HSFCTL, hsflctl.regval);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8435
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8436
    /* wait till FDONE bit is set to 1 */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8437
    do {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8438
        hsfsts.regval = E1000_READ_ICH_FLASH_REG16(hw, ICH_FLASH_HSFSTS);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8439
        if (hsfsts.hsf_status.flcdone == 1)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8440
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8441
        udelay(1);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8442
        i++;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8443
    } while (i < timeout);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8444
    if (hsfsts.hsf_status.flcdone == 1 && hsfsts.hsf_status.flcerr == 0) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8445
        error = E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8446
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8447
    return error;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8448
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8449
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8450
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8451
 * Reads a byte or word from the NVM using the ICH8 flash access registers.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8452
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8453
 * hw - The pointer to the hw structure
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8454
 * index - The index of the byte or word to read.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8455
 * size - Size of data to read, 1=byte 2=word
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8456
 * data - Pointer to the word to store the value read.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8457
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8458
static s32 e1000_read_ich8_data(struct e1000_hw *hw, u32 index, u32 size,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8459
				u16 *data)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8460
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8461
    union ich8_hws_flash_status hsfsts;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8462
    union ich8_hws_flash_ctrl hsflctl;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8463
    u32 flash_linear_address;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8464
    u32 flash_data = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8465
    s32 error = -E1000_ERR_EEPROM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8466
    s32 count = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8467
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8468
    DEBUGFUNC("e1000_read_ich8_data");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8469
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8470
    if (size < 1  || size > 2 || data == NULL ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8471
        index > ICH_FLASH_LINEAR_ADDR_MASK)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8472
        return error;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8473
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8474
    flash_linear_address = (ICH_FLASH_LINEAR_ADDR_MASK & index) +
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8475
                           hw->flash_base_addr;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8476
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8477
    do {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8478
        udelay(1);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8479
        /* Steps */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8480
        error = e1000_ich8_cycle_init(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8481
        if (error != E1000_SUCCESS)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8482
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8483
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8484
        hsflctl.regval = E1000_READ_ICH_FLASH_REG16(hw, ICH_FLASH_HSFCTL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8485
        /* 0b/1b corresponds to 1 or 2 byte size, respectively. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8486
        hsflctl.hsf_ctrl.fldbcount = size - 1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8487
        hsflctl.hsf_ctrl.flcycle = ICH_CYCLE_READ;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8488
        E1000_WRITE_ICH_FLASH_REG16(hw, ICH_FLASH_HSFCTL, hsflctl.regval);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8489
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8490
        /* Write the last 24 bits of index into Flash Linear address field in
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8491
         * Flash Address */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8492
        /* TODO: TBD maybe check the index against the size of flash */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8493
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8494
        E1000_WRITE_ICH_FLASH_REG(hw, ICH_FLASH_FADDR, flash_linear_address);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8495
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8496
        error = e1000_ich8_flash_cycle(hw, ICH_FLASH_COMMAND_TIMEOUT);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8497
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8498
        /* Check if FCERR is set to 1, if set to 1, clear it and try the whole
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8499
         * sequence a few more times, else read in (shift in) the Flash Data0,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8500
         * the order is least significant byte first msb to lsb */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8501
        if (error == E1000_SUCCESS) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8502
            flash_data = E1000_READ_ICH_FLASH_REG(hw, ICH_FLASH_FDATA0);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8503
            if (size == 1) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8504
                *data = (u8)(flash_data & 0x000000FF);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8505
            } else if (size == 2) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8506
                *data = (u16)(flash_data & 0x0000FFFF);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8507
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8508
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8509
        } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8510
            /* If we've gotten here, then things are probably completely hosed,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8511
             * but if the error condition is detected, it won't hurt to give
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8512
             * it another try...ICH_FLASH_CYCLE_REPEAT_COUNT times.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8513
             */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8514
            hsfsts.regval = E1000_READ_ICH_FLASH_REG16(hw, ICH_FLASH_HSFSTS);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8515
            if (hsfsts.hsf_status.flcerr == 1) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8516
                /* Repeat for some time before giving up. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8517
                continue;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8518
            } else if (hsfsts.hsf_status.flcdone == 0) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8519
                DEBUGOUT("Timeout error - flash cycle did not complete.");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8520
                break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8521
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8522
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8523
    } while (count++ < ICH_FLASH_CYCLE_REPEAT_COUNT);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8524
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8525
    return error;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8526
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8527
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8528
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8529
 * Writes One /two bytes to the NVM using the ICH8 flash access registers.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8530
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8531
 * hw - The pointer to the hw structure
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8532
 * index - The index of the byte/word to read.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8533
 * size - Size of data to read, 1=byte 2=word
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8534
 * data - The byte(s) to write to the NVM.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8535
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8536
static s32 e1000_write_ich8_data(struct e1000_hw *hw, u32 index, u32 size,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8537
				 u16 data)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8538
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8539
    union ich8_hws_flash_status hsfsts;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8540
    union ich8_hws_flash_ctrl hsflctl;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8541
    u32 flash_linear_address;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8542
    u32 flash_data = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8543
    s32 error = -E1000_ERR_EEPROM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8544
    s32 count = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8545
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8546
    DEBUGFUNC("e1000_write_ich8_data");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8547
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8548
    if (size < 1  || size > 2 || data > size * 0xff ||
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8549
        index > ICH_FLASH_LINEAR_ADDR_MASK)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8550
        return error;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8551
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8552
    flash_linear_address = (ICH_FLASH_LINEAR_ADDR_MASK & index) +
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8553
                           hw->flash_base_addr;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8554
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8555
    do {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8556
        udelay(1);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8557
        /* Steps */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8558
        error = e1000_ich8_cycle_init(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8559
        if (error != E1000_SUCCESS)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8560
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8561
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8562
        hsflctl.regval = E1000_READ_ICH_FLASH_REG16(hw, ICH_FLASH_HSFCTL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8563
        /* 0b/1b corresponds to 1 or 2 byte size, respectively. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8564
        hsflctl.hsf_ctrl.fldbcount = size -1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8565
        hsflctl.hsf_ctrl.flcycle = ICH_CYCLE_WRITE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8566
        E1000_WRITE_ICH_FLASH_REG16(hw, ICH_FLASH_HSFCTL, hsflctl.regval);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8567
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8568
        /* Write the last 24 bits of index into Flash Linear address field in
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8569
         * Flash Address */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8570
        E1000_WRITE_ICH_FLASH_REG(hw, ICH_FLASH_FADDR, flash_linear_address);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8571
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8572
        if (size == 1)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8573
            flash_data = (u32)data & 0x00FF;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8574
        else
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8575
            flash_data = (u32)data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8576
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8577
        E1000_WRITE_ICH_FLASH_REG(hw, ICH_FLASH_FDATA0, flash_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8578
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8579
        /* check if FCERR is set to 1 , if set to 1, clear it and try the whole
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8580
         * sequence a few more times else done */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8581
        error = e1000_ich8_flash_cycle(hw, ICH_FLASH_COMMAND_TIMEOUT);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8582
        if (error == E1000_SUCCESS) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8583
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8584
        } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8585
            /* If we're here, then things are most likely completely hosed,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8586
             * but if the error condition is detected, it won't hurt to give
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8587
             * it another try...ICH_FLASH_CYCLE_REPEAT_COUNT times.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8588
             */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8589
            hsfsts.regval = E1000_READ_ICH_FLASH_REG16(hw, ICH_FLASH_HSFSTS);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8590
            if (hsfsts.hsf_status.flcerr == 1) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8591
                /* Repeat for some time before giving up. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8592
                continue;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8593
            } else if (hsfsts.hsf_status.flcdone == 0) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8594
                DEBUGOUT("Timeout error - flash cycle did not complete.");
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8595
                break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8596
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8597
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8598
    } while (count++ < ICH_FLASH_CYCLE_REPEAT_COUNT);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8599
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8600
    return error;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8601
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8602
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8603
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8604
 * Reads a single byte from the NVM using the ICH8 flash access registers.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8605
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8606
 * hw - pointer to e1000_hw structure
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8607
 * index - The index of the byte to read.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8608
 * data - Pointer to a byte to store the value read.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8609
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8610
static s32 e1000_read_ich8_byte(struct e1000_hw *hw, u32 index, u8 *data)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8611
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8612
    s32 status = E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8613
    u16 word = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8614
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8615
    status = e1000_read_ich8_data(hw, index, 1, &word);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8616
    if (status == E1000_SUCCESS) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8617
        *data = (u8)word;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8618
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8619
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8620
    return status;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8621
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8622
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8623
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8624
 * Writes a single byte to the NVM using the ICH8 flash access registers.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8625
 * Performs verification by reading back the value and then going through
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8626
 * a retry algorithm before giving up.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8627
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8628
 * hw - pointer to e1000_hw structure
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8629
 * index - The index of the byte to write.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8630
 * byte - The byte to write to the NVM.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8631
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8632
static s32 e1000_verify_write_ich8_byte(struct e1000_hw *hw, u32 index, u8 byte)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8633
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8634
    s32 error = E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8635
    s32 program_retries = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8636
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8637
    DEBUGOUT2("Byte := %2.2X Offset := %d\n", byte, index);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8638
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8639
    error = e1000_write_ich8_byte(hw, index, byte);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8640
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8641
    if (error != E1000_SUCCESS) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8642
        for (program_retries = 0; program_retries < 100; program_retries++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8643
            DEBUGOUT2("Retrying \t Byte := %2.2X Offset := %d\n", byte, index);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8644
            error = e1000_write_ich8_byte(hw, index, byte);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8645
            udelay(100);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8646
            if (error == E1000_SUCCESS)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8647
                break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8648
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8649
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8650
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8651
    if (program_retries == 100)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8652
        error = E1000_ERR_EEPROM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8653
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8654
    return error;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8655
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8656
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8657
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8658
 * Writes a single byte to the NVM using the ICH8 flash access registers.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8659
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8660
 * hw - pointer to e1000_hw structure
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8661
 * index - The index of the byte to read.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8662
 * data - The byte to write to the NVM.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8663
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8664
static s32 e1000_write_ich8_byte(struct e1000_hw *hw, u32 index, u8 data)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8665
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8666
    s32 status = E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8667
    u16 word = (u16)data;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8668
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8669
    status = e1000_write_ich8_data(hw, index, 1, word);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8670
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8671
    return status;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8672
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8673
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8674
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8675
 * Reads a word from the NVM using the ICH8 flash access registers.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8676
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8677
 * hw - pointer to e1000_hw structure
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8678
 * index - The starting byte index of the word to read.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8679
 * data - Pointer to a word to store the value read.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8680
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8681
static s32 e1000_read_ich8_word(struct e1000_hw *hw, u32 index, u16 *data)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8682
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8683
    s32 status = E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8684
    status = e1000_read_ich8_data(hw, index, 2, data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8685
    return status;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8686
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8687
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8688
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8689
 * Erases the bank specified. Each bank may be a 4, 8 or 64k block. Banks are 0
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8690
 * based.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8691
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8692
 * hw - pointer to e1000_hw structure
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8693
 * bank - 0 for first bank, 1 for second bank
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8694
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8695
 * Note that this function may actually erase as much as 8 or 64 KBytes.  The
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8696
 * amount of NVM used in each bank is a *minimum* of 4 KBytes, but in fact the
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8697
 * bank size may be 4, 8 or 64 KBytes
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8698
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8699
static s32 e1000_erase_ich8_4k_segment(struct e1000_hw *hw, u32 bank)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8700
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8701
    union ich8_hws_flash_status hsfsts;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8702
    union ich8_hws_flash_ctrl hsflctl;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8703
    u32 flash_linear_address;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8704
    s32  count = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8705
    s32  error = E1000_ERR_EEPROM;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8706
    s32  iteration;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8707
    s32  sub_sector_size = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8708
    s32  bank_size;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8709
    s32  j = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8710
    s32  error_flag = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8711
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8712
    hsfsts.regval = E1000_READ_ICH_FLASH_REG16(hw, ICH_FLASH_HSFSTS);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8713
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8714
    /* Determine HW Sector size: Read BERASE bits of Hw flash Status register */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8715
    /* 00: The Hw sector is 256 bytes, hence we need to erase 16
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8716
     *     consecutive sectors.  The start index for the nth Hw sector can be
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8717
     *     calculated as bank * 4096 + n * 256
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8718
     * 01: The Hw sector is 4K bytes, hence we need to erase 1 sector.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8719
     *     The start index for the nth Hw sector can be calculated
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8720
     *     as bank * 4096
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8721
     * 10: The HW sector is 8K bytes
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8722
     * 11: The Hw sector size is 64K bytes */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8723
    if (hsfsts.hsf_status.berasesz == 0x0) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8724
        /* Hw sector size 256 */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8725
        sub_sector_size = ICH_FLASH_SEG_SIZE_256;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8726
        bank_size = ICH_FLASH_SECTOR_SIZE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8727
        iteration = ICH_FLASH_SECTOR_SIZE / ICH_FLASH_SEG_SIZE_256;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8728
    } else if (hsfsts.hsf_status.berasesz == 0x1) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8729
        bank_size = ICH_FLASH_SEG_SIZE_4K;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8730
        iteration = 1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8731
    } else if (hsfsts.hsf_status.berasesz == 0x3) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8732
        bank_size = ICH_FLASH_SEG_SIZE_64K;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8733
        iteration = 1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8734
    } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8735
        return error;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8736
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8737
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8738
    for (j = 0; j < iteration ; j++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8739
        do {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8740
            count++;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8741
            /* Steps */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8742
            error = e1000_ich8_cycle_init(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8743
            if (error != E1000_SUCCESS) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8744
                error_flag = 1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8745
                break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8746
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8747
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8748
            /* Write a value 11 (block Erase) in Flash Cycle field in Hw flash
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8749
             * Control */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8750
            hsflctl.regval = E1000_READ_ICH_FLASH_REG16(hw, ICH_FLASH_HSFCTL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8751
            hsflctl.hsf_ctrl.flcycle = ICH_CYCLE_ERASE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8752
            E1000_WRITE_ICH_FLASH_REG16(hw, ICH_FLASH_HSFCTL, hsflctl.regval);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8753
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8754
            /* Write the last 24 bits of an index within the block into Flash
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8755
             * Linear address field in Flash Address.  This probably needs to
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8756
             * be calculated here based off the on-chip erase sector size and
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8757
             * the software bank size (4, 8 or 64 KBytes) */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8758
            flash_linear_address = bank * bank_size + j * sub_sector_size;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8759
            flash_linear_address += hw->flash_base_addr;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8760
            flash_linear_address &= ICH_FLASH_LINEAR_ADDR_MASK;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8761
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8762
            E1000_WRITE_ICH_FLASH_REG(hw, ICH_FLASH_FADDR, flash_linear_address);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8763
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8764
            error = e1000_ich8_flash_cycle(hw, ICH_FLASH_ERASE_TIMEOUT);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8765
            /* Check if FCERR is set to 1.  If 1, clear it and try the whole
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8766
             * sequence a few more times else Done */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8767
            if (error == E1000_SUCCESS) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8768
                break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8769
            } else {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8770
                hsfsts.regval = E1000_READ_ICH_FLASH_REG16(hw, ICH_FLASH_HSFSTS);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8771
                if (hsfsts.hsf_status.flcerr == 1) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8772
                    /* repeat for some time before giving up */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8773
                    continue;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8774
                } else if (hsfsts.hsf_status.flcdone == 0) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8775
                    error_flag = 1;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8776
                    break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8777
                }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8778
            }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8779
        } while ((count < ICH_FLASH_CYCLE_REPEAT_COUNT) && !error_flag);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8780
        if (error_flag == 1)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8781
            break;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8782
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8783
    if (error_flag != 1)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8784
        error = E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8785
    return error;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8786
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8787
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8788
static s32 e1000_init_lcd_from_nvm_config_region(struct e1000_hw *hw,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8789
						 u32 cnf_base_addr,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8790
						 u32 cnf_size)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8791
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8792
    u32 ret_val = E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8793
    u16 word_addr, reg_data, reg_addr;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8794
    u16 i;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8795
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8796
    /* cnf_base_addr is in DWORD */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8797
    word_addr = (u16)(cnf_base_addr << 1);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8798
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8799
    /* cnf_size is returned in size of dwords */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8800
    for (i = 0; i < cnf_size; i++) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8801
        ret_val = e1000_read_eeprom(hw, (word_addr + i*2), 1, &reg_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8802
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8803
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8804
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8805
        ret_val = e1000_read_eeprom(hw, (word_addr + i*2 + 1), 1, &reg_addr);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8806
        if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8807
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8808
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8809
        ret_val = e1000_get_software_flag(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8810
        if (ret_val != E1000_SUCCESS)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8811
            return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8812
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8813
        ret_val = e1000_write_phy_reg_ex(hw, (u32)reg_addr, reg_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8814
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8815
        e1000_release_software_flag(hw);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8816
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8817
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8818
    return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8819
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8820
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8821
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8822
/******************************************************************************
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8823
 * This function initializes the PHY from the NVM on ICH8 platforms. This
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8824
 * is needed due to an issue where the NVM configuration is not properly
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8825
 * autoloaded after power transitions. Therefore, after each PHY reset, we
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8826
 * will load the configuration data out of the NVM manually.
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8827
 *
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8828
 * hw: Struct containing variables accessed by shared code
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8829
 *****************************************************************************/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8830
static s32 e1000_init_lcd_from_nvm(struct e1000_hw *hw)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8831
{
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8832
    u32 reg_data, cnf_base_addr, cnf_size, ret_val, loop;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8833
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8834
    if (hw->phy_type != e1000_phy_igp_3)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8835
          return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8836
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8837
    /* Check if SW needs configure the PHY */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8838
    reg_data = er32(FEXTNVM);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8839
    if (!(reg_data & FEXTNVM_SW_CONFIG))
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8840
        return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8841
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8842
    /* Wait for basic configuration completes before proceeding*/
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8843
    loop = 0;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8844
    do {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8845
        reg_data = er32(STATUS) & E1000_STATUS_LAN_INIT_DONE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8846
        udelay(100);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8847
        loop++;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8848
    } while ((!reg_data) && (loop < 50));
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8849
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8850
    /* Clear the Init Done bit for the next init event */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8851
    reg_data = er32(STATUS);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8852
    reg_data &= ~E1000_STATUS_LAN_INIT_DONE;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8853
    ew32(STATUS, reg_data);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8854
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8855
    /* Make sure HW does not configure LCD from PHY extended configuration
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8856
       before SW configuration */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8857
    reg_data = er32(EXTCNF_CTRL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8858
    if ((reg_data & E1000_EXTCNF_CTRL_LCD_WRITE_ENABLE) == 0x0000) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8859
        reg_data = er32(EXTCNF_SIZE);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8860
        cnf_size = reg_data & E1000_EXTCNF_SIZE_EXT_PCIE_LENGTH;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8861
        cnf_size >>= 16;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8862
        if (cnf_size) {
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8863
            reg_data = er32(EXTCNF_CTRL);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8864
            cnf_base_addr = reg_data & E1000_EXTCNF_CTRL_EXT_CNF_POINTER;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8865
            /* cnf_base_addr is in DWORD */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8866
            cnf_base_addr >>= 16;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8867
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8868
            /* Configure LCD from extended configuration region. */
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8869
            ret_val = e1000_init_lcd_from_nvm_config_region(hw, cnf_base_addr,
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8870
                                                            cnf_size);
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8871
            if (ret_val)
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8872
                return ret_val;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8873
        }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8874
    }
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8875
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8876
    return E1000_SUCCESS;
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8877
}
852668fdae6a Added e1000 port for 2.6.31
Christoph Mathys <ch1010832@ch10pc602>
parents:
diff changeset
  8878