[mirror_ubuntu-eoan-kernel.git] / arch / arm / mach-orion5x / tsx09-common.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;
	}
}
Commit	Line	Data
2874c5fd	1	// SPDX-License-Identifier: GPL-2.0-or-later
530c854a SB	2	/*
	3	* QNAP TS-x09 Boards common functions
	4	*
	5	* Maintainers: Lennert Buytenhek <buytenh@marvell.com>
	6	* Byron Bradley <byron.bbradley@gmail.com>
530c854a SB	7	*/
	8
	9	#include <linux/kernel.h>
	10	#include <linux/pci.h>
	11	#include <linux/mv643xx_eth.h>
a10b188f	12	#include <linux/timex.h>
530c854a	13	#include <linux/serial_reg.h>
c22c2c60	14	#include "orion5x.h"
530c854a	15	#include "tsx09-common.h"
ebe35aff	16	#include "common.h"
530c854a SB	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
	24	void qnap_tsx09_power_off(void)
	25	{
	26	/* 19200 baud divisor */
ebe35aff	27	const unsigned divisor = ((orion5x_tclk + (8 * 19200)) / (16 * 19200));
530c854a SB	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
	48	struct mv643xx_eth_platform_data qnap_tsx09_eth_data = {
ac840605	49	.phy_addr = MV643XX_ETH_PHY_ADDR(8),
530c854a SB	50	};
530c854a SB	51
13a55372 DM	52	static 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
	66	static 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
530c854a SB	80	static int __init qnap_tsx09_check_mac_addr(const char *addr_str)
	81	{
	82	u_int8_t addr[6];
13a55372	83	int i;
530c854a	84
13a55372 DM	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	}
530c854a	99
7a1436d5	100	printk(KERN_INFO "tsx09: found ethernet mac address %pM\n", addr);
530c854a SB	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	*/
	112	void __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) {
13a55372	117	char *nor_page;
530c854a SB	118	int ret = 0;
	119
	120	nor_page = ioremap(addr, 1024);
	121	if (nor_page != NULL) {
13a55372	122	ret = qnap_tsx09_check_mac_addr(nor_page);
530c854a SB	123	iounmap(nor_page);
	124	}
	125
	126	if (ret == 0)
	127	break;
	128	}
	129	}