7e5f460ec4
It is a pain to have to specify the value 16 in each call. Add a new hextoul() function and update the code to use it. Add a proper comment to simple_strtoul() while we are here. Signed-off-by: Simon Glass <sjg@chromium.org>
170 lines
3.7 KiB
C
170 lines
3.7 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 <command.h>
|
|
#include <cpu_func.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(struct cmd_tbl *cmdtp, int flag, int argc,
|
|
char *const argv[])
|
|
{
|
|
u32 addr, val;
|
|
|
|
if (argc < 3)
|
|
return CMD_RET_USAGE;
|
|
|
|
addr = hextoul(argv[2], NULL);
|
|
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 = hextoul(argv[3], NULL);
|
|
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(void)
|
|
{
|
|
cpld_write(CPLD_ADDR_RESET, 1);
|
|
}
|