From: Andreas Pfefferle <ap(a)denx.de>
This patch adds diagnosis functions for the buzzer, UARTs and digital
IOs on inka4x0 hardware.
Signed-off-by: Andreas Pfefferle <ap(a)denx.de>
---
board/inka4x0/Makefile | 2 +-
board/inka4x0/inkadiag.c | 515 ++++++++++++++++++++++++++++++++++++++++++++++
2 files changed, 516 insertions(+), 1 deletions(-)
create mode 100644 board/inka4x0/inkadiag.c
diff --git a/board/inka4x0/Makefile b/board/inka4x0/Makefile
index 442e2d0..2264dae 100644
--- a/board/inka4x0/Makefile
+++ b/board/inka4x0/Makefile
@@ -25,7 +25,7 @@ include $(TOPDIR)/config.mk
LIB = $(obj)lib$(BOARD).a
-COBJS := $(BOARD).o
+COBJS := $(BOARD).o inkadiag.o
SRCS := $(SOBJS:.o=.S) $(COBJS:.o=.c)
OBJS := $(addprefix $(obj),$(COBJS))
diff --git a/board/inka4x0/inkadiag.c b/board/inka4x0/inkadiag.c
new file mode 100644
index 0000000..6194b58
--- /dev/null
+++ b/board/inka4x0/inkadiag.c
@@ -0,0 +1,515 @@
+/*
+ * (C) Copyright 2008
+ * Andreas Pfefferle, DENX Software Engineering, ap(a)denx.de.
+ *
+ * See file CREDITS for list of people who contributed to this
+ * project.
+ *
+ * This program is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU General Public License as
+ * published by the Free Software Foundation; either version 2 of
+ * the License, or (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
+ * MA 02111-1307 USA
+ */
+
+#include <asm/io.h>
+#include <common.h>
+#include <config.h>
+#include <mpc5xxx.h>
+#include <pci.h>
+
+#include <command.h>
+
+#define TEST_NAME(test, name) static char test##_program_name[] = name
+#define TEST_USAGE(test, usage) static char test##_program_usage[] = usage
+#define TEST_FUNCTION(test) do_##test
+#define PRINT_TEST_USAGE(test) do {\
+ printf(test##_program_usage, test##_program_name);\
+ return -1;\
+} while (0)
+
+#define GPIO_BASE (u_char *)0x30400000
+
+#define DIGIN_TOUCHSCR_MASK 0x00003000 /* Inputs 12-13 */
+#define DIGIN_KEYB_MASK 0x00010000 /* Input 16 */
+
+#define DIGIN_DRAWER_SW1 0x00400000 /* Input 22 */
+#define DIGIN_DRAWER_SW2 0x00800000 /* Input 23 */
+
+#define DIGIO_LED0 0x00000001 /* Output 0 */
+#define DIGIO_LED1 0x00000002 /* Output 1 */
+#define DIGIO_LED2 0x00000004 /* Output 2 */
+#define DIGIO_LED3 0x00000008 /* Output 3 */
+#define DIGIO_LED4 0x00000010 /* Output 4 */
+#define DIGIO_LED5 0x00000020 /* Output 5 */
+
+#define DIGIO_DRAWER1 0x00000100 /* Output 8 */
+#define DIGIO_DRAWER2 0x00000200 /* Output 9 */
+
+static unsigned int inka_digin_get_input(void)
+{
+ return in_8(GPIO_BASE + 0) << 0 | in_8(GPIO_BASE + 1) << 8 |
+ in_8(GPIO_BASE + 2) << 16 | in_8(GPIO_BASE + 3) << 24;
+}
+
+#define LED_HIGH(NUM)\
+out_be32((unsigned *)MPC5XXX_GPT##NUM##_ENABLE,\
+ in_be32((unsigned *)MPC5XXX_GPT##NUM##_ENABLE) | 0x10)
+
+#define LED_LOW(NUM)\
+out_be32((unsigned *)MPC5XXX_GPT##NUM##_ENABLE,\
+ in_be32((unsigned *)MPC5XXX_GPT##NUM##_ENABLE) & ~0x10)
+
+#define CHECK_LED(NUM) do {\
+ if (state & (1 << NUM)) {\
+ LED_HIGH(NUM);\
+ } else {\
+ LED_LOW(NUM);\
+ } \
+} while (0)
+
+static void inka_digio_set_output(unsigned int state, int which)
+{
+ if (which == 0) {
+ CHECK_LED(0);
+ CHECK_LED(1);
+ CHECK_LED(2);
+ CHECK_LED(3);
+ CHECK_LED(4);
+ CHECK_LED(5);
+ } else {
+ struct mpc5xxx_gpio *gpio = (struct mpc5xxx_gpio *)MPC5XXX_GPIO;
+ if (which == 1) {
+ if (state & DIGIO_DRAWER1) {
+ gpio->simple_dvo &= ~0x1000;
+ udelay(1);
+ gpio->simple_dvo |= 0x1000;
+ } else {
+ gpio->simple_dvo |= 0x1000;
+ udelay(1);
+ gpio->simple_dvo &= ~0x1000;
+ }
+ }
+ if (which == 2) {
+ if (state & DIGIO_DRAWER2) {
+ gpio->simple_dvo &= ~0x2000;
+ udelay(1);
+ gpio->simple_dvo |= 0x2000;
+ } else {
+ gpio->simple_dvo |= 0x2000;
+ udelay(1);
+ gpio->simple_dvo &= ~0x2000;
+ }
+ }
+ }
+ udelay(1);
+}
+
+TEST_NAME(io, "inkadiag io");
+TEST_USAGE(io, "Usage: %s\n\
+ <which> # get which[drawer1|drawer2|other] input\n\
+ <which> <val> # set which[drawer1|drawer2|other] output to val\n\
+");
+
+static int io_helper(int argc, char *argv[])
+{
+ unsigned int state = inka_digin_get_input();
+ if (strcmp(argv[1], "drawer1") == 0) {
+ printf("exit code: 0x%X\n",
+ (state & DIGIN_DRAWER_SW1) >> (ffs(DIGIN_DRAWER_SW1) - 1));
+ } else if (strcmp(argv[1], "drawer2") == 0) {
+ printf("exit code: 0x%X\n",
+ (state & DIGIN_DRAWER_SW2) >> (ffs(DIGIN_DRAWER_SW2) - 1));
+ } else if (strcmp(argv[1], "other") == 0) {
+ printf("exit code: 0x%X\n",
+ ((state & DIGIN_KEYB_MASK) >> (ffs(DIGIN_KEYB_MASK) - 1))
+ | ((state & DIGIN_TOUCHSCR_MASK) >>
+ (ffs(DIGIN_TOUCHSCR_MASK) - 2)));
+ } else {
+ printf("Invalid argument: %s\n", argv[1]);
+ return -1;
+ }
+ return 0;
+}
+
+static int TEST_FUNCTION(io) (cmd_tbl_t *cmdtp, int flag, int argc,
+ char *argv[]) {
+ if ((argc < 2) || (argc > 3))
+ PRINT_TEST_USAGE(io);
+
+ if (argc == 2)
+ return io_helper(argc, argv);
+
+ unsigned int val = simple_strtol(argv[2], NULL, 16);
+
+ if (strcmp(argv[1], "drawer1") == 0) {
+ val <<= (ffs(DIGIO_DRAWER1) - 1);
+ inka_digio_set_output(val, 1);
+ } else if (strcmp(argv[1], "drawer2") == 0) {
+ val <<= (ffs(DIGIO_DRAWER2) - 1);
+ inka_digio_set_output(val, 2);
+ } else if (strcmp(argv[1], "other") == 0)
+ inka_digio_set_output(val, 0);
+ else {
+ printf("Invalid argument: %s\n", argv[1]);
+ return -1;
+ }
+ return io_helper(argc, argv);
+}
+
+DECLARE_GLOBAL_DATA_PTR;
+
+static int ser_init(volatile struct mpc5xxx_psc *psc, int baudrate)
+{
+ unsigned long baseclk;
+ int div;
+
+ /* reset PSC */
+ psc->command = PSC_SEL_MODE_REG_1;
+
+ /* select clock sources */
+
+ psc->psc_clock_select = 0;
+ baseclk = (gd->ipb_clk + 16) / 32;
+
+ /* switch to UART mode */
+ psc->sicr = 0;
+
+ /* configure parity, bit length and so on */
+
+ psc->mode = PSC_MODE_8_BITS | PSC_MODE_PARNONE;
+
+ psc->mode = PSC_MODE_ONE_STOP;
+
+ /* set up UART divisor */
+ div = (baseclk + (baudrate / 2)) / baudrate;
+ psc->ctur = (div >> 8) & 0xff;
+ psc->ctlr = div & 0xff;
+
+ /* disable all interrupts */
+ psc->psc_imr = 0;
+
+ /* reset and enable Rx/Tx */
+ psc->command = PSC_RST_RX;
+ psc->command = PSC_RST_TX;
+ psc->command = PSC_RX_ENABLE | PSC_TX_ENABLE;
+
+ return 0;
+}
+
+static void ser_putc(volatile struct mpc5xxx_psc *psc, const char c)
+{
+ /* Wait for last character to go. */
+ int i = 0;
+ while (!(psc->psc_status & PSC_SR_TXEMP) && (i++ < CONFIG_SYS_HZ))
+ udelay(10);
+ psc->psc_buffer_8 = c;
+
+}
+
+static int ser_getc(volatile struct mpc5xxx_psc *psc)
+{
+ /* Wait for a character to arrive. */
+ int i = 0;
+ while (!(psc->psc_status & PSC_SR_RXRDY) && (i++ < CONFIG_SYS_HZ))
+ udelay(10);
+
+ return psc->psc_buffer_8;
+}
+
+#define SERIAL_PORT_BASE (u_char *)0x80000000
+
+#define UART_RX 0 /* In: Receive buffer (DLAB=0) */
+#define UART_TX 0 /* Out: Transmit buffer (DLAB=0) */
+#define UART_DLL 0 /* Out: Divisor Latch Low (DLAB=1) */
+
+#define UART_LCR 3 /* Out: Line Control Register */
+#define UART_MCR 4 /* Out: Modem Control Register */
+
+#define UART_LSR 5 /* In: Line Status Register */
+#define UART_MSR 6 /* In: Modem Status Register */
+
+#define UART_LCR_WLEN8 0x03 /* Wordlength: 8 bits */
+#define UART_LCR_DLAB 0x80 /* Divisor latch access bit */
+
+#define UART_LSR_THRE 0x20 /* Transmit-hold-register empty */
+#define UART_LSR_DR 0x01 /* Receiver data ready */
+
+#define UART_MCR_LOOP 0x10 /* Enable loopback test mode */
+#define UART_MCR_RTS 0x02 /* RTS complement */
+#define UART_MCR_DTR 0x01 /* DTR complement */
+
+#define UART_MSR_DCD 0x80 /* Data Carrier Detect */
+#define UART_MSR_DSR 0x20 /* Data Set Ready */
+#define UART_MSR_CTS 0x10 /* Clear to Send */
+#define PSC_OP1_RTS 0x01
+#define PSC_OP0_RTS 0x01
+
+static unsigned char serial_in(unsigned char num, int offset)
+{
+ return in_8(SERIAL_PORT_BASE + (num << 3) + offset);
+}
+
+static void serial_out(unsigned char num, int offset, unsigned char value)
+{
+ out_8(SERIAL_PORT_BASE + (num << 3) + offset, value);
+}
+
+TEST_NAME(serial, "inkadiag serial");
+TEST_USAGE(serial, "Usage: %s\n\
+ <num> <mode> <baudrate> <msg> # test uart num [0..11] in mode\
+ and baudrate with msg\n\
+");
+
+static int TEST_FUNCTION(serial) (cmd_tbl_t *cmdtp, int flag, int argc,
+ char *argv[]) {
+ if (argc < 5)
+ PRINT_TEST_USAGE(serial);
+
+ argc--;
+ argv++;
+
+ unsigned int num = simple_strtol(argv[0], NULL, 0);
+ if (num < 0 || num > 11) {
+ printf("invalid argument for num: %d\n", num);
+ return -1;
+ }
+
+ unsigned int mode = simple_strtol(argv[1], NULL, 0);
+
+ int combrd = 0;
+
+ if (strcmp(argv[2], "115200") == 0)
+ combrd = 1;
+ else if (strcmp(argv[2], "57600") == 0)
+ combrd = 2;
+ else if (strcmp(argv[2], "38400") == 0)
+ combrd = 3;
+ else if (strcmp(argv[2], "19200") == 0)
+ combrd = 6;
+ else if (strcmp(argv[2], "9600") == 0)
+ combrd = 12;
+ else if (strcmp(argv[2], "2400") == 0)
+ combrd = 48;
+ else if (strcmp(argv[2], "1200") == 0)
+ combrd = 96;
+ else if (strcmp(argv[2], "300") == 0)
+ combrd = 384;
+ else
+ printf("Invalid baudrate: %s", argv[2]);
+
+ printf("Testing uart %d.\n\n", num);
+
+ if ((num >= 0) && (num <= 7)) {
+ if (mode & 1)
+ /* turn on 'loopback' mode */
+ serial_out(num, UART_MCR, UART_MCR_LOOP);
+ else {
+ /* establish the UART's operational parameters */
+ /* set DLAB=1 */
+ serial_out(num, UART_LCR, UART_LCR_DLAB);
+ /* set baudrate */
+ serial_out(num, UART_DLL, combrd);
+ /* set data-format: 8-N-1 */
+ serial_out(num, UART_LCR, UART_LCR_WLEN8);
+ }
+
+ if (mode & 2) {
+ /* set request to send */
+ serial_out(num, UART_MCR, UART_MCR_RTS);
+ udelay(10);
+ /* check clear to send */
+ if ((serial_in(num, UART_MSR) & UART_MSR_CTS) == 0x00)
+ return -1;
+ }
+ if (mode & 4) {
+ /* set data terminal ready */
+ serial_out(num, UART_MCR, UART_MCR_DTR);
+ udelay(10);
+ /* check data set ready and carrier detect */
+ if ((serial_in(num, UART_MSR) &
+ (UART_MSR_DSR | UART_MSR_DCD))
+ != (UART_MSR_DSR | UART_MSR_DCD))
+ return -1;
+ }
+
+ /* write each message-character, read it back, and display it */
+ int i, len = strlen(argv[3]);
+ for (i = 0; i < len; ++i) {
+ int j = 0;
+ while ((serial_in(num, UART_LSR) & UART_LSR_THRE) ==
+ 0x00) {
+ if (j++ > CONFIG_SYS_HZ)
+ break;
+ udelay(10);
+ }
+ serial_out(num, UART_TX, argv[3][i]);
+ j = 0;
+ while ((serial_in(num, UART_LSR) & UART_LSR_DR) ==
+ 0x00) {
+ if (j++ > CONFIG_SYS_HZ)
+ break;
+ udelay(10);
+ }
+ unsigned char data = serial_in(num, UART_RX);
+ printf("%c", data);
+ }
+ printf("\n\n");
+ serial_out(num, UART_MCR, 0x00);
+ } else {
+ int address, irq;
+ switch (num) {
+ case 8:
+ address = MPC5XXX_PSC6;
+ irq = MPC5XXX_PSC6_IRQ;
+ break;
+ case 9:
+ address = MPC5XXX_PSC3;
+ irq = MPC5XXX_PSC3_IRQ;
+ break;
+ case 10:
+ address = MPC5XXX_PSC2;
+ irq = MPC5XXX_PSC2_IRQ;
+ break;
+ case 11:
+ address = MPC5XXX_PSC1;
+ irq = MPC5XXX_PSC1_IRQ;
+ break;
+ }
+ volatile struct mpc5xxx_psc *psc =
+ (struct mpc5xxx_psc *)address;
+ ser_init(psc, simple_strtol(argv[2], NULL, 0));
+ if (mode & 2) {
+ /* set request to send */
+ out_8(&psc->op0, PSC_OP0_RTS);
+ udelay(10);
+ /* check clear to send */
+ if ((in_8(&psc->ip) & PSC_IPCR_CTS) == 0)
+ return -1;
+ }
+ int i, len = strlen(argv[3]);
+ for (i = 0; i < len; ++i) {
+ ser_putc(psc, argv[3][i]);
+ printf("%c", ser_getc(psc));
+ }
+ printf("\n\n");
+ }
+ return 0;
+}
+
+#define BUZZER_GPT (MPC5XXX_GPT + 0x60) /* GPT6 */
+static void buzzer_turn_on(unsigned int freq)
+{
+ struct mpc5xxx_gpt *gpt = (struct mpc5xxx_gpt *)(BUZZER_GPT);
+
+ const u32 prescale = gd->ipb_clk / freq / 128;
+ const u32 count = 128;
+ const u32 width = 64;
+
+ gpt->cir = (prescale << 16) | count;
+ gpt->pwmcr = width << 16;
+ gpt->emsr = 3; /* Timer enabled for PWM */
+}
+
+static void buzzer_turn_off(void)
+{
+ struct mpc5xxx_gpt *gpt = (struct mpc5xxx_gpt *)(BUZZER_GPT);
+ gpt->emsr = 0;
+}
+
+TEST_NAME(buzzer, "inkadiag buzzer");
+TEST_USAGE(buzzer, "Usage: %s\n\
+ <period> <freq> # turn buzzer on for period ms with freq hz\n\
+");
+
+static int TEST_FUNCTION(buzzer) (cmd_tbl_t *cmdtp, int flag, int argc,
+ char *argv[]) {
+
+ if (argc != 3)
+ PRINT_TEST_USAGE(buzzer);
+
+ argc--;
+ argv++;
+
+ unsigned int period = simple_strtol(argv[0], NULL, 0);
+ if (!period)
+ printf("Zero period is senseless\n");
+ argc--;
+ argv++;
+
+ unsigned int freq = simple_strtol(argv[0], NULL, 0);
+ /* avoid zero prescale in buzzer_turn_on() */
+ if (freq > gd->ipb_clk / 128)
+ printf("%dHz exceeds maximum (%dHz)\n", freq,
+ gd->ipb_clk / 128);
+ else if (!freq)
+ printf("Zero frequency is senseless\n");
+ else
+ buzzer_turn_on(freq);
+
+ clear_ctrlc();
+ int prev = disable_ctrlc(0);
+
+ printf("Buzzing for %d ms. Type ^C to abort!\n\n", period);
+
+ int i = 0;
+
+ while (!ctrlc() && (i++ < CONFIG_SYS_HZ))
+ udelay(period);
+
+ clear_ctrlc();
+ disable_ctrlc(prev);
+
+ buzzer_turn_off();
+
+ return 0;
+}
+
+TEST_NAME(inkadiag, "inkadiag");
+TEST_USAGE(inkadiag, "Usage: %s\n\
+ [buzzer]\n\
+ [io]\n\
+ [serial]\n\
+");
+
+#define IS_TEST(test) \
+ (strncmp(&argv[0][0], #test, strlen(#test)) == 0)
+
+#define CHECK_TEST(test) do {\
+ if (IS_TEST(test)) {\
+ return TEST_FUNCTION(test) (cmdtp, flag, argc, argv);\
+ } \
+} while (0)
+
+static int TEST_FUNCTION(inkadiag) (cmd_tbl_t *cmdtp, int flag, int argc,
+ char *argv[]) {
+ switch (argc) {
+ case 1:
+ PRINT_TEST_USAGE(inkadiag);
+ default:
+ argc--;
+ argv++;
+ CHECK_TEST(io);
+ CHECK_TEST(serial);
+ CHECK_TEST(buzzer);
+ }
+ PRINT_TEST_USAGE(inkadiag);
+}
+
+U_BOOT_CMD(inkadiag, 6, 1, TEST_FUNCTION(inkadiag),
+ "inkadiag- inka diagnosis\n",
+ "[inkadiag what ...]\n"
+ " - perform a diagnosis on inka hardware\n"
+ "'inkadiag' performs hardware tests.\n\n"
+ "Without arguments, inkadiag prints a list of available tests.\n\n"
+ "To get detailed help information for specific tests you can type\n"
+ "'inkadiag what' with a test name 'what' as argument.\n");
--
1.6.0.4
