src/mainboard/google/beltino/lan.c

   1 /* SPDX-License-Identifier: GPL-2.0-only */
   2
   3 #include <cbfs.h>
   4 #include <types.h>
   5 #include <arch/io.h>
   6 #include <device/pci_ops.h>
   7 #include <console/console.h>
   8 #include <device/device.h>
   9 #include <fmap.h>
  10 #include <southbridge/intel/bd82x6x/pch.h>
  11 #include "onboard.h"
  12
  13 static unsigned int search(char *p, u8 *a, unsigned int lengthp,
  14                            unsigned int lengtha)
  15 {
  16         int i, j;
  17
  18         /* Searching */
  19         for (j = 0; j <= lengtha - lengthp; j++) {
  20                 for (i = 0; i < lengthp && p[i] == a[i + j]; i++)
  21                         ;
  22                 if (i >= lengthp)
  23                         return j;
  24         }
  25         return lengtha;
  26 }
  27
  28 static unsigned char get_hex_digit(u8 *offset)
  29 {
  30         unsigned char retval = 0;
  31
  32         retval = *offset - '0';
  33         if (retval > 0x09) {
  34                 retval = *offset - 'A' + 0x0A;
  35                 if (retval > 0x0F)
  36                         retval = *offset - 'a' + 0x0a;
  37         }
  38         if (retval > 0x0F) {
  39                 printk(BIOS_ERR, "Invalid Hex digit found: %c - 0x%02x\n", *offset, *offset);
  40                 retval = 0;
  41         }
  42
  43         return retval;
  44 }
  45
  46 static int get_mac_address(u32 *high_dword, u32 *low_dword,
  47                            u8 *search_address, u32 search_length)
  48 {
  49         char key[] = "ethernet_mac";
  50         unsigned int offset;
  51         int i;
  52
  53         offset = search(key, search_address, sizeof(key) - 1, search_length);
  54         if (offset == search_length) {
  55                 printk(BIOS_ERR, "Could not locate '%s' in VPD\n", key);
  56                 return 0;
  57         }
  58         printk(BIOS_DEBUG, "Located '%s' in VPD\n", key);
  59
  60         offset += sizeof(key);  /* move to next character */
  61         *high_dword = 0;
  62
  63         /* Fetch the MAC address and put the octets in the correct order to
  64          * be programmed.
  65          *
  66          * From RTL8105E_Series_EEPROM-Less_App_Note_1.1
  67          * If the MAC address is 001122334455h:
  68          * Write 33221100h to I/O register offset 0x00 via double word access
  69          * Write 00005544h to I/O register offset 0x04 via double word access
  70          */
  71
  72         for (i = 0; i < 4; i++) {
  73                 *high_dword |= (get_hex_digit(search_address + offset)
  74                                 << (4 + (i * 8)));
  75                 *high_dword |= (get_hex_digit(search_address + offset + 1)
  76                                 << (i * 8));
  77                 offset += 3;
  78         }
  79
  80         *low_dword = 0;
  81         for (i = 0; i < 2; i++) {
  82                 *low_dword |= (get_hex_digit(search_address + offset)
  83                                << (4 + (i * 8)));
  84                 *low_dword |= (get_hex_digit(search_address + offset + 1)
  85                                << (i * 8));
  86                 offset += 3;
  87         }
  88
  89         return *high_dword | *low_dword;
  90 }
  91
  92 static void program_mac_address(u16 io_base)
  93 {
  94         void *search_address = NULL;
  95         size_t search_length = -1;
  96
  97         /* Default MAC Address of A0:00:BA:D0:0B:AD */
  98         u32 high_dword = 0xD0BA00A0;    /* high dword of mac address */
  99         u32 low_dword = 0x0000AD0B;     /* low word of mac address as a dword */
 100
 101         if (CONFIG(VPD)) {
 102                 struct region_device rdev;
 103
 104                 if (fmap_locate_area_as_rdev("RO_VPD", &rdev) == 0) {
 105                         search_address = rdev_mmap_full(&rdev);
 106
 107                         if (search_address != NULL)
 108                                 search_length = region_device_sz(&rdev);
 109                 }
 110         } else {
 111                 search_address = cbfs_map("vpd.bin", &search_length);
 112         }
 113
 114         if (search_address == NULL)
 115                 printk(BIOS_ERR, "LAN: VPD not found.\n");
 116         else
 117                 get_mac_address(&high_dword, &low_dword, search_address,
 118                                 search_length);
 119
 120         if (io_base) {
 121                 printk(BIOS_DEBUG, "Realtek NIC io_base = 0x%04x\n", io_base);
 122                 printk(BIOS_DEBUG, "Programming MAC Address\n");
 123
 124                 /* Disable register protection */
 125                 outb(0xc0, io_base + 0x50);
 126                 outl(high_dword, io_base);
 127                 outl(low_dword, io_base + 0x04);
 128                 outb(0x60, io_base + 54);
 129                 /* Enable register protection again */
 130                 outb(0x00, io_base + 0x50);
 131         }
 132 }
 133
 134 void lan_init(void)
 135 {
 136         u16 io_base = 0;
 137         struct device *ethernet_dev = NULL;
 138
 139         /* Get NIC's IO base address */
 140         ethernet_dev = dev_find_device(NIC_VENDOR_ID,
 141                                        NIC_DEVICE_ID, 0);
 142         if (ethernet_dev != NULL) {
 143                 io_base = pci_read_config16(ethernet_dev, 0x10) & 0xfffe;
 144
 145                 /*
 146                  * Battery life time - LAN PCIe should enter ASPM L1 to save
 147                  * power when LAN connection is idle.
 148                  * enable CLKREQ: LAN pci config space 0x81h=01
 149                  */
 150                 pci_write_config8(ethernet_dev, 0x81, 0x01);
 151         }
 152
 153         if (io_base) {
 154                 /* Program MAC address based on VPD data */
 155                 program_mac_address(io_base);
 156
 157                 /*
 158                  * Program NIC LEDS
 159                  *
 160                  * RTL8105E Series EEPROM-Less Application Note,
 161                  * Section 5.6 LED Mode Configuration
 162                  *
 163                  * Step1: Write C0h to I/O register 0x50 via byte access to
 164                  *        disable 'register protection'
 165                  * Step2: Write xx001111b to I/O register 0x52 via byte access
 166                  *        (bit7 is LEDS1 and bit6 is LEDS0)
 167                  * Step3: Write 0x00 to I/O register 0x50 via byte access to
 168                  *        enable 'register protection'
 169                  */
 170                 outb(0xc0, io_base + 0x50);     /* Disable protection */
 171                 outb((NIC_LED_MODE << 6) | 0x0f, io_base + 0x52);
 172                 outb(0x00, io_base + 0x50);     /* Enable register protection */
 173         }
 174 }