167 lines
		
	
	
		
			3.6 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			167 lines
		
	
	
		
			3.6 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
// SPDX-License-Identifier: GPL-2.0
 | 
						|
/*
 | 
						|
 * Stout board CPLD access support
 | 
						|
 *
 | 
						|
 * Copyright (C) 2015 Renesas Electronics Europe GmbH
 | 
						|
 * Copyright (C) 2015 Renesas Electronics Corporation
 | 
						|
 * Copyright (C) 2015 Cogent Embedded, Inc.
 | 
						|
 */
 | 
						|
 | 
						|
#include <common.h>
 | 
						|
#include <asm/io.h>
 | 
						|
#include <asm/gpio.h>
 | 
						|
#include "cpld.h"
 | 
						|
 | 
						|
#define SCLK			(92 + 24)
 | 
						|
#define SSTBZ			(92 + 25)
 | 
						|
#define MOSI			(92 + 26)
 | 
						|
#define MISO			(92 + 27)
 | 
						|
 | 
						|
#define CPLD_ADDR_MODE		0x00 /* RW */
 | 
						|
#define CPLD_ADDR_MUX		0x01 /* RW */
 | 
						|
#define CPLD_ADDR_HDMI		0x02 /* RW */
 | 
						|
#define CPLD_ADDR_DIPSW		0x08 /* R */
 | 
						|
#define CPLD_ADDR_RESET		0x80 /* RW */
 | 
						|
#define CPLD_ADDR_VERSION	0xFF /* R */
 | 
						|
 | 
						|
static u32 cpld_read(u8 addr)
 | 
						|
{
 | 
						|
	int i;
 | 
						|
	u32 data = 0;
 | 
						|
 | 
						|
	for (i = 0; i < 8; i++) {
 | 
						|
		gpio_set_value(MOSI, addr & 0x80); /* MSB first */
 | 
						|
		gpio_set_value(SCLK, 1);
 | 
						|
		addr <<= 1;
 | 
						|
		gpio_set_value(SCLK, 0);
 | 
						|
	}
 | 
						|
 | 
						|
	gpio_set_value(MOSI, 0); /* READ */
 | 
						|
	gpio_set_value(SSTBZ, 0);
 | 
						|
	gpio_set_value(SCLK, 1);
 | 
						|
	gpio_set_value(SCLK, 0);
 | 
						|
	gpio_set_value(SSTBZ, 1);
 | 
						|
 | 
						|
	for (i = 0; i < 32; i++) {
 | 
						|
		gpio_set_value(SCLK, 1);
 | 
						|
		data <<= 1;
 | 
						|
		data |= gpio_get_value(MISO); /* MSB first */
 | 
						|
		gpio_set_value(SCLK, 0);
 | 
						|
	}
 | 
						|
 | 
						|
	return data;
 | 
						|
}
 | 
						|
 | 
						|
static void cpld_write(u8 addr, u32 data)
 | 
						|
{
 | 
						|
	int i;
 | 
						|
 | 
						|
	for (i = 0; i < 32; i++) {
 | 
						|
		gpio_set_value(MOSI, data & (1 << 31)); /* MSB first */
 | 
						|
		gpio_set_value(SCLK, 1);
 | 
						|
		data <<= 1;
 | 
						|
		gpio_set_value(SCLK, 0);
 | 
						|
	}
 | 
						|
 | 
						|
	for (i = 0; i < 8; i++) {
 | 
						|
		gpio_set_value(MOSI, addr & 0x80); /* MSB first */
 | 
						|
		gpio_set_value(SCLK, 1);
 | 
						|
		addr <<= 1;
 | 
						|
		gpio_set_value(SCLK, 0);
 | 
						|
	}
 | 
						|
 | 
						|
	gpio_set_value(MOSI, 1); /* WRITE */
 | 
						|
	gpio_set_value(SSTBZ, 0);
 | 
						|
	gpio_set_value(SCLK, 1);
 | 
						|
	gpio_set_value(SCLK, 0);
 | 
						|
	gpio_set_value(SSTBZ, 1);
 | 
						|
}
 | 
						|
 | 
						|
/* LSI pin pull-up control */
 | 
						|
#define PUPR3		0xe606010C
 | 
						|
#define PUPR3_SD3_DAT1	(1 << 27)
 | 
						|
 | 
						|
void cpld_init(void)
 | 
						|
{
 | 
						|
	u32 val;
 | 
						|
 | 
						|
	/* PULL-UP on MISO line */
 | 
						|
	val = readl(PUPR3);
 | 
						|
	val |= PUPR3_SD3_DAT1;
 | 
						|
	writel(val, PUPR3);
 | 
						|
 | 
						|
	gpio_request(SCLK, "SCLK");
 | 
						|
	gpio_request(SSTBZ, "SSTBZ");
 | 
						|
	gpio_request(MOSI, "MOSI");
 | 
						|
	gpio_request(MISO, "MISO");
 | 
						|
 | 
						|
	gpio_direction_output(SCLK, 0);
 | 
						|
	gpio_direction_output(SSTBZ, 1);
 | 
						|
	gpio_direction_output(MOSI, 0);
 | 
						|
	gpio_direction_input(MISO);
 | 
						|
 | 
						|
	/* dummy read */
 | 
						|
	cpld_read(CPLD_ADDR_VERSION);
 | 
						|
 | 
						|
	printf("CPLD version:              0x%08x\n",
 | 
						|
	       cpld_read(CPLD_ADDR_VERSION));
 | 
						|
	printf("H2 Mode setting (MD0..28): 0x%08x\n",
 | 
						|
	       cpld_read(CPLD_ADDR_MODE));
 | 
						|
	printf("Multiplexer settings:      0x%08x\n",
 | 
						|
	       cpld_read(CPLD_ADDR_MUX));
 | 
						|
	printf("HDMI setting:              0x%08x\n",
 | 
						|
	       cpld_read(CPLD_ADDR_HDMI));
 | 
						|
	printf("DIPSW (SW3):               0x%08x\n",
 | 
						|
	       cpld_read(CPLD_ADDR_DIPSW));
 | 
						|
 | 
						|
#ifdef CONFIG_SH_SDHI
 | 
						|
	/* switch MUX to SD0 */
 | 
						|
	val = cpld_read(CPLD_ADDR_MUX);
 | 
						|
	val &= ~MUX_MSK_SD0;
 | 
						|
	val |= MUX_VAL_SD0;
 | 
						|
	cpld_write(CPLD_ADDR_MUX, val);
 | 
						|
#endif
 | 
						|
}
 | 
						|
 | 
						|
static int do_cpld(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
 | 
						|
{
 | 
						|
	u32 addr, val;
 | 
						|
 | 
						|
	if (argc < 3)
 | 
						|
		return CMD_RET_USAGE;
 | 
						|
 | 
						|
	addr = simple_strtoul(argv[2], NULL, 16);
 | 
						|
	if (!(addr == CPLD_ADDR_VERSION || addr == CPLD_ADDR_MODE ||
 | 
						|
	      addr == CPLD_ADDR_MUX || addr == CPLD_ADDR_HDMI ||
 | 
						|
	      addr == CPLD_ADDR_DIPSW || addr == CPLD_ADDR_RESET)) {
 | 
						|
		printf("cpld invalid addr\n");
 | 
						|
		return CMD_RET_USAGE;
 | 
						|
	}
 | 
						|
 | 
						|
	if (argc == 3 && strcmp(argv[1], "read") == 0) {
 | 
						|
		printf("0x%x\n", cpld_read(addr));
 | 
						|
	} else if (argc == 4 && strcmp(argv[1], "write") == 0) {
 | 
						|
		val = simple_strtoul(argv[3], NULL, 16);
 | 
						|
		if (addr == CPLD_ADDR_MUX) {
 | 
						|
			/* never mask SCIFA0 console */
 | 
						|
			val &= ~MUX_MSK_SCIFA0_USB;
 | 
						|
			val |= MUX_VAL_SCIFA0_USB;
 | 
						|
		}
 | 
						|
		cpld_write(addr, val);
 | 
						|
	}
 | 
						|
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
U_BOOT_CMD(
 | 
						|
	cpld, 4, 1, do_cpld,
 | 
						|
	"CPLD access",
 | 
						|
	"read addr\n"
 | 
						|
	"cpld write addr val\n"
 | 
						|
);
 | 
						|
 | 
						|
void reset_cpu(ulong addr)
 | 
						|
{
 | 
						|
	cpld_write(CPLD_ADDR_RESET, 1);
 | 
						|
}
 |