Changeset 33539


Ignore:
Timestamp:
2012-09-25T14:57:40+02:00 (5 years ago)
Author:
juhosg
Message:

ar71xx: automatically find WLAN calibration data on TEW-673GRU

File:
1 edited

Legend:

Unmodified
Added
Removed
  • trunk/target/linux/ar71xx/files/arch/mips/ath79/mach-tew-673gru.c

    r31108 r33539  
    4141#define TEW673GRU_KEYS_DEBOUNCE_INTERVAL (3 * TEW673GRU_KEYS_POLL_INTERVAL) 
    4242 
    43 #define TEW673GRU_CAL_LOCATION_0        0x1f661000 
    44 #define TEW673GRU_CAL_LOCATION_1        0x1f665000 
    45  
    46 #define TEW673GRU_MAC_LOCATION_0        0x1f66ffa0 
    47 #define TEW673GRU_MAC_LOCATION_1        0x1f66ffb4 
     43#define TEW673GRU_CAL0_OFFSET           0x1000 
     44#define TEW673GRU_CAL1_OFFSET           0x5000 
     45#define TEW673GRU_MAC0_OFFSET           0xffa0 
     46#define TEW673GRU_MAC1_OFFSET           0xffb4 
     47 
     48#define TEW673GRU_CAL_LOCATION_0        0x1f660000 
     49#define TEW673GRU_CAL_LOCATION_1        0x1f7f0000 
    4850 
    4951static struct gpio_led tew673gru_leds_gpio[] __initdata = { 
     
    118120}; 
    119121 
    120 static void tew673gru_read_ascii_mac(u8 *dest, unsigned int src_addr) 
     122static void tew673gru_read_ascii_mac(u8 *dest, u8 *src) 
    121123{ 
    122124        int ret; 
    123         u8 *src = (u8 *)KSEG1ADDR(src_addr); 
    124125 
    125126        ret = sscanf(src, "%02hhx:%02hhx:%02hhx:%02hhx:%02hhx:%02hhx", 
     
    127128                     &dest[3], &dest[4], &dest[5]); 
    128129 
    129         if (ret != ETH_ALEN) memset(dest, 0, ETH_ALEN); 
     130        if (ret != ETH_ALEN) 
     131                memset(dest, 0, ETH_ALEN); 
     132} 
     133 
     134static bool __init tew673gru_is_caldata_valid(u8 *p) 
     135{ 
     136        u16 *magic0, *magic1; 
     137 
     138        magic0 = (u16 *)(p + TEW673GRU_CAL0_OFFSET); 
     139        magic1 = (u16 *)(p + TEW673GRU_CAL1_OFFSET); 
     140 
     141        return (*magic0 == 0xa55a && *magic1 == 0xa55a); 
     142} 
     143 
     144static void __init tew673gru_wlan_init(void) 
     145{ 
     146        u8 mac1[ETH_ALEN], mac2[ETH_ALEN]; 
     147        u8 *caldata; 
     148 
     149        caldata = (u8 *) KSEG1ADDR(TEW673GRU_CAL_LOCATION_0); 
     150        if (!tew673gru_is_caldata_valid(caldata)) { 
     151                caldata = (u8 *)KSEG1ADDR(TEW673GRU_CAL_LOCATION_1); 
     152                if (!tew673gru_is_caldata_valid(caldata)) { 
     153                        pr_err("no calibration data found\n"); 
     154                        return; 
     155                } 
     156        } 
     157 
     158        tew673gru_read_ascii_mac(mac1, caldata + TEW673GRU_MAC0_OFFSET); 
     159        tew673gru_read_ascii_mac(mac2, caldata + TEW673GRU_MAC1_OFFSET); 
     160 
     161        ath79_init_mac(ath79_eth0_data.mac_addr, mac1, 2); 
     162        ath79_init_mac(ath79_eth1_data.mac_addr, mac1, 3); 
     163 
     164        ap9x_pci_setup_wmac_led_pin(0, 5); 
     165        ap9x_pci_setup_wmac_led_pin(1, 5); 
     166 
     167        ap94_pci_init(caldata + TEW673GRU_CAL0_OFFSET, mac1, 
     168                      caldata + TEW673GRU_CAL1_OFFSET, mac2); 
    130169} 
    131170 
    132171static void __init tew673gru_setup(void) 
    133172{ 
    134         u8 mac1[ETH_ALEN], mac2[ETH_ALEN]; 
    135  
    136         tew673gru_read_ascii_mac(mac1, TEW673GRU_MAC_LOCATION_0); 
    137         tew673gru_read_ascii_mac(mac2, TEW673GRU_MAC_LOCATION_1); 
     173        tew673gru_wlan_init(); 
    138174 
    139175        ath79_register_mdio(0, 0x0); 
    140176 
    141         ath79_init_mac(ath79_eth0_data.mac_addr, mac1, 2); 
    142177        ath79_eth0_data.mii_bus_dev = &tew673gru_rtl8366s_device.dev; 
    143178        ath79_eth0_data.phy_if_mode = PHY_INTERFACE_MODE_RGMII; 
     
    146181        ath79_eth0_pll_data.pll_1000 = 0x11110000; 
    147182 
    148         ath79_init_mac(ath79_eth1_data.mac_addr, mac1, 3); 
    149183        ath79_eth1_data.mii_bus_dev = &tew673gru_rtl8366s_device.dev; 
    150184        ath79_eth1_data.phy_if_mode = PHY_INTERFACE_MODE_RGMII; 
     
    168202        platform_device_register(&tew673gru_rtl8366s_device); 
    169203 
    170         ap9x_pci_setup_wmac_led_pin(0, 5); 
    171         ap9x_pci_setup_wmac_led_pin(1, 5); 
    172  
    173         ap94_pci_init((u8 *) KSEG1ADDR(TEW673GRU_CAL_LOCATION_0), mac1, 
    174                       (u8 *) KSEG1ADDR(TEW673GRU_CAL_LOCATION_1), mac2); 
    175  
    176204        spi_register_board_info(tew673gru_spi_info, 
    177205                                ARRAY_SIZE(tew673gru_spi_info)); 
Note: See TracChangeset for help on using the changeset viewer.