Quelle  tsx09-common.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0-or-later
/*
 * QNAP TS-x09 Boards common functions
 *
 * Maintainers: Lennert Buytenhek <buytenh@marvell.com>
 * Byron Bradley <byron.bbradley@gmail.com>
 */

#include <linux/kernel.h>
#include <linux/pci.h>
#include <linux/mv643xx_eth.h>
#include <linux/timex.h>
#include <linux/serial_reg.h>
#include "orion5x.h"
#include "tsx09-common.h"
#include "common.h"

/*****************************************************************************
 * QNAP TS-x09 specific power off method via UART1-attached PIC
 ****************************************************************************/

#define UART1_REG(x) (UART1_VIRT_BASE + ((UART_##x) << 2))

void qnap_tsx09_power_off(void)
{
 /* 19200 baud divisor */
 const unsigned divisor = ((orion5x_tclk + (8 * 19200)) / (16 * 19200));

 pr_info("%s: triggering power-off...\n", __func__);

 /* hijack uart1 and reset into sane state (19200,8n1) */
 writel(0x83, UART1_REG(LCR));
 writel(divisor & 0xff, UART1_REG(DLL));
 writel((divisor >> 8) & 0xff, UART1_REG(DLM));
 writel(0x03, UART1_REG(LCR));
 writel(0x00, UART1_REG(IER));
 writel(0x00, UART1_REG(FCR));
 writel(0x00, UART1_REG(MCR));

 /* send the power-off command 'A' to PIC */
 writel('A', UART1_REG(TX));
}

/*****************************************************************************
 * Ethernet
 ****************************************************************************/

struct mv643xx_eth_platform_data qnap_tsx09_eth_data = {
 .phy_addr = MV643XX_ETH_PHY_ADDR(8),
};

static int __init qnap_tsx09_parse_hex_nibble(char n)
{
 if (n >= '0' && n <= '9')
  return n - '0';

 if (n >= 'A' && n <= 'F')
  return n - 'A' + 10;

 if (n >= 'a' && n <= 'f')
  return n - 'a' + 10;

 return -1;
}

static int __init qnap_tsx09_parse_hex_byte(const char *b)
{
 int hi;
 int lo;

 hi = qnap_tsx09_parse_hex_nibble(b[0]);
 lo = qnap_tsx09_parse_hex_nibble(b[1]);

 if (hi < 0 || lo < 0)
  return -1;

 return (hi << 4) | lo;
}

static int __init qnap_tsx09_check_mac_addr(const char *addr_str)
{
 u_int8_t addr[6];
 int i;

 for (i = 0; i < 6; i++) {
  int byte;

  /*
 * Enforce "xx:xx:xx:xx:xx:xx\n" format.
 */
  if (addr_str[(i * 3) + 2] != ((i < 5) ? ':' : '\n'))
   return -1;

  byte = qnap_tsx09_parse_hex_byte(addr_str + (i * 3));
  if (byte < 0)
   return -1;
  addr[i] = byte;
 }

 printk(KERN_INFO "tsx09: found ethernet mac address %pM\n", addr);

 memcpy(qnap_tsx09_eth_data.mac_addr, addr, 6);

 return 0;
}

/*
 * The 'NAS Config' flash partition has an ext2 filesystem which
 * contains a file that has the ethernet MAC address in plain text
 * (format "xx:xx:xx:xx:xx:xx\n").
 */
void __init qnap_tsx09_find_mac_addr(u32 mem_base, u32 size)
{
 unsigned long addr;

 for (addr = mem_base; addr < (mem_base + size); addr += 1024) {
  char *nor_page;
  int ret = 0;

  nor_page = ioremap(addr, 1024);
  if (nor_page != NULL) {
   ret = qnap_tsx09_check_mac_addr(nor_page);
   iounmap(nor_page);
  }

  if (ret == 0)
   break;
 }
}