1*2e192b24SSimon Glass /*
2*2e192b24SSimon Glass * (C) Copyright 2013
3*2e192b24SSimon Glass * Dirk Eibach, Guntermann & Drunck GmbH, dirk.eibach@gdsys.cc
4*2e192b24SSimon Glass *
5*2e192b24SSimon Glass * based on cmd_mem.c
6*2e192b24SSimon Glass * (C) Copyright 2000
7*2e192b24SSimon Glass * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
8*2e192b24SSimon Glass *
9*2e192b24SSimon Glass * SPDX-License-Identifier: GPL-2.0+
10*2e192b24SSimon Glass */
11*2e192b24SSimon Glass
12*2e192b24SSimon Glass #include <common.h>
13*2e192b24SSimon Glass #include <command.h>
14*2e192b24SSimon Glass #include <console.h>
15*2e192b24SSimon Glass
16*2e192b24SSimon Glass #include <gdsys_fpga.h>
17*2e192b24SSimon Glass
18*2e192b24SSimon Glass static uint dp_last_fpga;
19*2e192b24SSimon Glass static uint dp_last_addr;
20*2e192b24SSimon Glass static uint dp_last_length = 0x40;
21*2e192b24SSimon Glass
22*2e192b24SSimon Glass /*
23*2e192b24SSimon Glass * FPGA Memory Display
24*2e192b24SSimon Glass *
25*2e192b24SSimon Glass * Syntax:
26*2e192b24SSimon Glass * fpgad {fpga} {addr} {len}
27*2e192b24SSimon Glass */
28*2e192b24SSimon Glass #define DISP_LINE_LEN 16
do_fpga_md(cmd_tbl_t * cmdtp,int flag,int argc,char * const argv[])29*2e192b24SSimon Glass int do_fpga_md(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
30*2e192b24SSimon Glass {
31*2e192b24SSimon Glass unsigned int k;
32*2e192b24SSimon Glass unsigned int fpga;
33*2e192b24SSimon Glass ulong addr, length;
34*2e192b24SSimon Glass int rc = 0;
35*2e192b24SSimon Glass u16 linebuf[DISP_LINE_LEN/sizeof(u16)];
36*2e192b24SSimon Glass ulong nbytes;
37*2e192b24SSimon Glass
38*2e192b24SSimon Glass /*
39*2e192b24SSimon Glass * We use the last specified parameters, unless new ones are
40*2e192b24SSimon Glass * entered.
41*2e192b24SSimon Glass */
42*2e192b24SSimon Glass fpga = dp_last_fpga;
43*2e192b24SSimon Glass addr = dp_last_addr;
44*2e192b24SSimon Glass length = dp_last_length;
45*2e192b24SSimon Glass
46*2e192b24SSimon Glass if (argc < 3)
47*2e192b24SSimon Glass return CMD_RET_USAGE;
48*2e192b24SSimon Glass
49*2e192b24SSimon Glass if ((flag & CMD_FLAG_REPEAT) == 0) {
50*2e192b24SSimon Glass /*
51*2e192b24SSimon Glass * FPGA is specified since argc > 2
52*2e192b24SSimon Glass */
53*2e192b24SSimon Glass fpga = simple_strtoul(argv[1], NULL, 16);
54*2e192b24SSimon Glass
55*2e192b24SSimon Glass /*
56*2e192b24SSimon Glass * Address is specified since argc > 2
57*2e192b24SSimon Glass */
58*2e192b24SSimon Glass addr = simple_strtoul(argv[2], NULL, 16);
59*2e192b24SSimon Glass
60*2e192b24SSimon Glass /*
61*2e192b24SSimon Glass * If another parameter, it is the length to display.
62*2e192b24SSimon Glass * Length is the number of objects, not number of bytes.
63*2e192b24SSimon Glass */
64*2e192b24SSimon Glass if (argc > 3)
65*2e192b24SSimon Glass length = simple_strtoul(argv[3], NULL, 16);
66*2e192b24SSimon Glass }
67*2e192b24SSimon Glass
68*2e192b24SSimon Glass nbytes = length * sizeof(u16);
69*2e192b24SSimon Glass do {
70*2e192b24SSimon Glass ulong linebytes = (nbytes > DISP_LINE_LEN) ?
71*2e192b24SSimon Glass DISP_LINE_LEN : nbytes;
72*2e192b24SSimon Glass
73*2e192b24SSimon Glass for (k = 0; k < linebytes / sizeof(u16); ++k)
74*2e192b24SSimon Glass fpga_get_reg(fpga,
75*2e192b24SSimon Glass (u16 *)fpga_ptr[fpga] + addr
76*2e192b24SSimon Glass / sizeof(u16) + k,
77*2e192b24SSimon Glass addr + k * sizeof(u16),
78*2e192b24SSimon Glass &linebuf[k]);
79*2e192b24SSimon Glass print_buffer(addr, (void *)linebuf, sizeof(u16),
80*2e192b24SSimon Glass linebytes / sizeof(u16),
81*2e192b24SSimon Glass DISP_LINE_LEN / sizeof(u16));
82*2e192b24SSimon Glass
83*2e192b24SSimon Glass nbytes -= linebytes;
84*2e192b24SSimon Glass addr += linebytes;
85*2e192b24SSimon Glass if (ctrlc()) {
86*2e192b24SSimon Glass rc = 1;
87*2e192b24SSimon Glass break;
88*2e192b24SSimon Glass }
89*2e192b24SSimon Glass } while (nbytes > 0);
90*2e192b24SSimon Glass
91*2e192b24SSimon Glass dp_last_fpga = fpga;
92*2e192b24SSimon Glass dp_last_addr = addr;
93*2e192b24SSimon Glass dp_last_length = length;
94*2e192b24SSimon Glass return rc;
95*2e192b24SSimon Glass }
96*2e192b24SSimon Glass
97*2e192b24SSimon Glass U_BOOT_CMD(
98*2e192b24SSimon Glass fpgad, 4, 1, do_fpga_md,
99*2e192b24SSimon Glass "fpga register display",
100*2e192b24SSimon Glass "fpga address [# of objects]"
101*2e192b24SSimon Glass );
102