cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

tsx09-common.c (2988B)

      1// SPDX-License-Identifier: GPL-2.0-or-later
      2/*
      3 * QNAP TS-x09 Boards common functions
      4 *
      5 * Maintainers: Lennert Buytenhek <buytenh@marvell.com>
      6 *		Byron Bradley <byron.bbradley@gmail.com>
      7 */
      8
      9#include <linux/kernel.h>
     10#include <linux/pci.h>
     11#include <linux/mv643xx_eth.h>
     12#include <linux/timex.h>
     13#include <linux/serial_reg.h>
     14#include "orion5x.h"
     15#include "tsx09-common.h"
     16#include "common.h"
     17
     18/*****************************************************************************
     19 * QNAP TS-x09 specific power off method via UART1-attached PIC
     20 ****************************************************************************/
     21
     22#define UART1_REG(x)	(UART1_VIRT_BASE + ((UART_##x) << 2))
     23
     24void qnap_tsx09_power_off(void)
     25{
     26	/* 19200 baud divisor */
     27	const unsigned divisor = ((orion5x_tclk + (8 * 19200)) / (16 * 19200));
     28
     29	pr_info("%s: triggering power-off...\n", __func__);
     30
     31	/* hijack uart1 and reset into sane state (19200,8n1) */
     32	writel(0x83, UART1_REG(LCR));
     33	writel(divisor & 0xff, UART1_REG(DLL));
     34	writel((divisor >> 8) & 0xff, UART1_REG(DLM));
     35	writel(0x03, UART1_REG(LCR));
     36	writel(0x00, UART1_REG(IER));
     37	writel(0x00, UART1_REG(FCR));
     38	writel(0x00, UART1_REG(MCR));
     39
     40	/* send the power-off command 'A' to PIC */
     41	writel('A', UART1_REG(TX));
     42}
     43
     44/*****************************************************************************
     45 * Ethernet
     46 ****************************************************************************/
     47
     48struct mv643xx_eth_platform_data qnap_tsx09_eth_data = {
     49	.phy_addr	= MV643XX_ETH_PHY_ADDR(8),
     50};
     51
     52static int __init qnap_tsx09_parse_hex_nibble(char n)
     53{
     54	if (n >= '0' && n <= '9')
     55		return n - '0';
     56
     57	if (n >= 'A' && n <= 'F')
     58		return n - 'A' + 10;
     59
     60	if (n >= 'a' && n <= 'f')
     61		return n - 'a' + 10;
     62
     63	return -1;
     64}
     65
     66static int __init qnap_tsx09_parse_hex_byte(const char *b)
     67{
     68	int hi;
     69	int lo;
     70
     71	hi = qnap_tsx09_parse_hex_nibble(b[0]);
     72	lo = qnap_tsx09_parse_hex_nibble(b[1]);
     73
     74	if (hi < 0 || lo < 0)
     75		return -1;
     76
     77	return (hi << 4) | lo;
     78}
     79
     80static int __init qnap_tsx09_check_mac_addr(const char *addr_str)
     81{
     82	u_int8_t addr[6];
     83	int i;
     84
     85	for (i = 0; i < 6; i++) {
     86		int byte;
     87
     88		/*
     89		 * Enforce "xx:xx:xx:xx:xx:xx\n" format.
     90		 */
     91		if (addr_str[(i * 3) + 2] != ((i < 5) ? ':' : '\n'))
     92			return -1;
     93
     94		byte = qnap_tsx09_parse_hex_byte(addr_str + (i * 3));
     95		if (byte < 0)
     96			return -1;
     97		addr[i] = byte;
     98	}
     99
    100	printk(KERN_INFO "tsx09: found ethernet mac address %pM\n", addr);
    101
    102	memcpy(qnap_tsx09_eth_data.mac_addr, addr, 6);
    103
    104	return 0;
    105}
    106
    107/*
    108 * The 'NAS Config' flash partition has an ext2 filesystem which
    109 * contains a file that has the ethernet MAC address in plain text
    110 * (format "xx:xx:xx:xx:xx:xx\n").
    111 */
    112void __init qnap_tsx09_find_mac_addr(u32 mem_base, u32 size)
    113{
    114	unsigned long addr;
    115
    116	for (addr = mem_base; addr < (mem_base + size); addr += 1024) {
    117		char *nor_page;
    118		int ret = 0;
    119
    120		nor_page = ioremap(addr, 1024);
    121		if (nor_page != NULL) {
    122			ret = qnap_tsx09_check_mac_addr(nor_page);
    123			iounmap(nor_page);
    124		}
    125
    126		if (ret == 0)
    127			break;
    128	}
    129}