cmd: Add axi command
Add a command to debug the AXI bus. Reviewed-by: Simon Glass <sjg@chromium.org> Signed-off-by: Mario Six <mario.six@gdsys.cc>
This commit is contained in:
Mario Six
Anatolij Gustschin
parent
87940ec407
commit
37c4a5f6a5
3 changed files with 361 additions and 0 deletions
|
|
@ -1027,6 +1027,14 @@ config CMD_USB_MASS_STORAGE
|
|||
help
|
||||
USB mass storage support
|
||||
|
||||
config CMD_AXI
|
||||
bool "axi"
|
||||
depends on AXI
|
||||
help
|
||||
Enable the command "axi" for accessing AXI (Advanced eXtensible
|
||||
Interface) busses, a on-chip interconnect specification for managing
|
||||
functional blocks in SoC designs, which is also often used in designs
|
||||
involving FPGAs (e.g. communication with IP cores in Xilinx FPGAs).
|
||||
endmenu
|
||||
|
||||
|
||||
|
|
|
|||
|
|
@ -149,6 +149,7 @@ obj-$(CONFIG_CMD_ZFS) += zfs.o
|
|||
obj-$(CONFIG_CMD_DFU) += dfu.o
|
||||
obj-$(CONFIG_CMD_GPT) += gpt.o
|
||||
obj-$(CONFIG_CMD_ETHSW) += ethsw.o
|
||||
obj-$(CONFIG_CMD_AXI) += axi.o
|
||||
|
||||
# Power
|
||||
obj-$(CONFIG_CMD_PMIC) += pmic.o
|
||||
|
|
|
|||
352
cmd/axi.c
Normal file
352
cmd/axi.c
Normal file
|
|
@ -0,0 +1,352 @@
|
|||
// SPDX-License-Identifier: GPL-2.0+
|
||||
/*
|
||||
* (C) Copyright 2016
|
||||
* Dirk Eibach, Guntermann & Drunck GmbH, dirk.eibach@gdsys.cc
|
||||
*
|
||||
* (C) Copyright 2017, 2018
|
||||
* Mario Six, Guntermann & Drunck GmbH, mario.six@gdsys.cc
|
||||
*
|
||||
* SPDX-License-Identifier: GPL-2.0+
|
||||
*/
|
||||
|
||||
#include <common.h>
|
||||
#include <axi.h>
|
||||
#include <command.h>
|
||||
#include <console.h>
|
||||
#include <dm.h>
|
||||
|
||||
/* Currently selected AXI bus device */
|
||||
static struct udevice *axi_cur_bus;
|
||||
/* Transmission size from last command */
|
||||
static uint dp_last_size;
|
||||
/* Address from last command */
|
||||
static uint dp_last_addr;
|
||||
/* Number of bytes to display from last command; default = 64 */
|
||||
static uint dp_last_length = 0x40;
|
||||
|
||||
/**
|
||||
* show_bus() - Show devices on a single AXI bus
|
||||
* @bus: The AXI bus device to printt information for
|
||||
*/
|
||||
static void show_bus(struct udevice *bus)
|
||||
{
|
||||
struct udevice *dev;
|
||||
|
||||
printf("Bus %d:\t%s", bus->req_seq, bus->name);
|
||||
if (device_active(bus))
|
||||
printf(" (active %d)", bus->seq);
|
||||
printf("\n");
|
||||
for (device_find_first_child(bus, &dev);
|
||||
dev;
|
||||
device_find_next_child(&dev))
|
||||
printf(" %s\n", dev->name);
|
||||
}
|
||||
|
||||
/**
|
||||
* axi_set_cur_bus() - Set the currently active AXI bus
|
||||
* @busnum: The number of the bus (i.e. its sequence number) that should be
|
||||
* made active
|
||||
*
|
||||
* The operations supplied by this command operate only on the currently active
|
||||
* bus.
|
||||
*
|
||||
* Return: 0 if OK, -ve on error
|
||||
*/
|
||||
static int axi_set_cur_bus(unsigned int busnum)
|
||||
{
|
||||
struct udevice *bus;
|
||||
struct udevice *dummy;
|
||||
int ret;
|
||||
|
||||
/* Make sure that all sequence numbers are initialized */
|
||||
for (uclass_first_device(UCLASS_AXI, &dummy);
|
||||
dummy;
|
||||
uclass_next_device(&dummy))
|
||||
;
|
||||
|
||||
ret = uclass_get_device_by_seq(UCLASS_AXI, busnum, &bus);
|
||||
if (ret) {
|
||||
debug("%s: No bus %d\n", __func__, busnum);
|
||||
return ret;
|
||||
}
|
||||
axi_cur_bus = bus;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/**
|
||||
* axi_get_cur_bus() - Retrieve the currently active AXI bus device
|
||||
* @busp: Pointer to a struct udevice that receives the currently active bus
|
||||
* device
|
||||
*
|
||||
* Return: 0 if OK, -ve on error
|
||||
*/
|
||||
static int axi_get_cur_bus(struct udevice **busp)
|
||||
{
|
||||
if (!axi_cur_bus) {
|
||||
puts("No AXI bus selected\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
*busp = axi_cur_bus;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* Command handlers
|
||||
*/
|
||||
|
||||
static int do_axi_show_bus(cmd_tbl_t *cmdtp, int flag, int argc,
|
||||
char * const argv[])
|
||||
{
|
||||
struct udevice *dummy;
|
||||
|
||||
/* Make sure that all sequence numbers are initialized */
|
||||
for (uclass_first_device(UCLASS_AXI, &dummy);
|
||||
dummy;
|
||||
uclass_next_device(&dummy))
|
||||
;
|
||||
|
||||
if (argc == 1) {
|
||||
/* show all busses */
|
||||
struct udevice *bus;
|
||||
|
||||
for (uclass_first_device(UCLASS_AXI, &bus);
|
||||
bus;
|
||||
uclass_next_device(&bus))
|
||||
show_bus(bus);
|
||||
} else {
|
||||
int i;
|
||||
|
||||
/* show specific bus */
|
||||
i = simple_strtoul(argv[1], NULL, 10);
|
||||
|
||||
struct udevice *bus;
|
||||
int ret;
|
||||
|
||||
ret = uclass_get_device_by_seq(UCLASS_AXI, i, &bus);
|
||||
if (ret) {
|
||||
printf("Invalid bus %d: err=%d\n", i, ret);
|
||||
return CMD_RET_FAILURE;
|
||||
}
|
||||
show_bus(bus);
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int do_axi_bus_num(cmd_tbl_t *cmdtp, int flag, int argc,
|
||||
char * const argv[])
|
||||
{
|
||||
int ret = 0;
|
||||
int bus_no;
|
||||
|
||||
if (argc == 1) {
|
||||
/* querying current setting */
|
||||
struct udevice *bus;
|
||||
|
||||
if (!axi_get_cur_bus(&bus))
|
||||
bus_no = bus->seq;
|
||||
else
|
||||
bus_no = -1;
|
||||
|
||||
printf("Current bus is %d\n", bus_no);
|
||||
} else {
|
||||
bus_no = simple_strtoul(argv[1], NULL, 10);
|
||||
printf("Setting bus to %d\n", bus_no);
|
||||
|
||||
ret = axi_set_cur_bus(bus_no);
|
||||
if (ret)
|
||||
printf("Failure changing bus number (%d)\n", ret);
|
||||
}
|
||||
|
||||
return ret ? CMD_RET_FAILURE : 0;
|
||||
}
|
||||
|
||||
static int do_axi_md(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
|
||||
{
|
||||
/* Print that many bytes per line */
|
||||
const uint DISP_LINE_LEN = 16;
|
||||
u8 linebuf[DISP_LINE_LEN];
|
||||
unsigned int k;
|
||||
ulong addr, length, size;
|
||||
ulong nbytes;
|
||||
enum axi_size_t axisize;
|
||||
int unitsize;
|
||||
|
||||
/*
|
||||
* We use the last specified parameters, unless new ones are
|
||||
* entered.
|
||||
*/
|
||||
size = dp_last_size;
|
||||
addr = dp_last_addr;
|
||||
length = dp_last_length;
|
||||
|
||||
if (argc < 3)
|
||||
return CMD_RET_USAGE;
|
||||
|
||||
if (!axi_cur_bus) {
|
||||
puts("No AXI bus selected\n");
|
||||
return CMD_RET_FAILURE;
|
||||
}
|
||||
|
||||
if ((flag & CMD_FLAG_REPEAT) == 0) {
|
||||
size = simple_strtoul(argv[1], NULL, 10);
|
||||
|
||||
/*
|
||||
* Address is specified since argc >= 3
|
||||
*/
|
||||
addr = simple_strtoul(argv[2], NULL, 16);
|
||||
|
||||
/*
|
||||
* If there's another parameter, it is the length to display;
|
||||
* length is the number of objects, not number of bytes
|
||||
*/
|
||||
if (argc > 3)
|
||||
length = simple_strtoul(argv[3], NULL, 16);
|
||||
}
|
||||
|
||||
switch (size) {
|
||||
case 8:
|
||||
axisize = AXI_SIZE_8;
|
||||
unitsize = 1;
|
||||
break;
|
||||
case 16:
|
||||
axisize = AXI_SIZE_16;
|
||||
unitsize = 2;
|
||||
break;
|
||||
case 32:
|
||||
axisize = AXI_SIZE_32;
|
||||
unitsize = 4;
|
||||
break;
|
||||
default:
|
||||
printf("Unknown read size '%lu'\n", size);
|
||||
return CMD_RET_USAGE;
|
||||
};
|
||||
|
||||
nbytes = length * unitsize;
|
||||
do {
|
||||
ulong linebytes = (nbytes > DISP_LINE_LEN) ?
|
||||
DISP_LINE_LEN : nbytes;
|
||||
|
||||
for (k = 0; k < linebytes / unitsize; ++k) {
|
||||
int ret = axi_read(axi_cur_bus, addr + k * unitsize,
|
||||
linebuf + k * unitsize, axisize);
|
||||
|
||||
if (!ret) /* Continue if axi_read was successful */
|
||||
continue;
|
||||
|
||||
if (ret == -ENOSYS)
|
||||
printf("axi_read failed; read size not supported?\n");
|
||||
else
|
||||
printf("axi_read failed: err = %d\n", ret);
|
||||
|
||||
return CMD_RET_FAILURE;
|
||||
}
|
||||
print_buffer(addr, (void *)linebuf, unitsize,
|
||||
linebytes / unitsize,
|
||||
DISP_LINE_LEN / unitsize);
|
||||
|
||||
nbytes -= max(linebytes, 1UL);
|
||||
addr += linebytes;
|
||||
|
||||
if (ctrlc())
|
||||
break;
|
||||
} while (nbytes > 0);
|
||||
|
||||
dp_last_size = size;
|
||||
dp_last_addr = addr;
|
||||
dp_last_length = length;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int do_axi_mw(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
|
||||
{
|
||||
u32 writeval;
|
||||
ulong addr, count, size;
|
||||
enum axi_size_t axisize;
|
||||
|
||||
if (argc <= 3 || argc >= 6)
|
||||
return CMD_RET_USAGE;
|
||||
|
||||
size = simple_strtoul(argv[1], NULL, 10);
|
||||
|
||||
switch (size) {
|
||||
case 8:
|
||||
axisize = AXI_SIZE_8;
|
||||
break;
|
||||
case 16:
|
||||
axisize = AXI_SIZE_16;
|
||||
break;
|
||||
case 32:
|
||||
axisize = AXI_SIZE_32;
|
||||
break;
|
||||
default:
|
||||
printf("Unknown write size '%lu'\n", size);
|
||||
return CMD_RET_USAGE;
|
||||
};
|
||||
|
||||
/* Address is specified since argc > 4 */
|
||||
addr = simple_strtoul(argv[2], NULL, 16);
|
||||
|
||||
/* Get the value to write */
|
||||
writeval = simple_strtoul(argv[3], NULL, 16);
|
||||
|
||||
/* Count ? */
|
||||
if (argc == 5)
|
||||
count = simple_strtoul(argv[4], NULL, 16);
|
||||
else
|
||||
count = 1;
|
||||
|
||||
while (count-- > 0) {
|
||||
int ret = axi_write(axi_cur_bus, addr + count * sizeof(u32),
|
||||
&writeval, axisize);
|
||||
|
||||
if (ret) {
|
||||
printf("axi_write failed: err = %d\n", ret);
|
||||
return CMD_RET_FAILURE;
|
||||
}
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static cmd_tbl_t cmd_axi_sub[] = {
|
||||
U_BOOT_CMD_MKENT(bus, 1, 1, do_axi_show_bus, "", ""),
|
||||
U_BOOT_CMD_MKENT(dev, 1, 1, do_axi_bus_num, "", ""),
|
||||
U_BOOT_CMD_MKENT(md, 4, 1, do_axi_md, "", ""),
|
||||
U_BOOT_CMD_MKENT(mw, 5, 1, do_axi_mw, "", ""),
|
||||
};
|
||||
|
||||
static int do_ihs_axi(cmd_tbl_t *cmdtp, int flag, int argc,
|
||||
char * const argv[])
|
||||
{
|
||||
cmd_tbl_t *c;
|
||||
|
||||
if (argc < 2)
|
||||
return CMD_RET_USAGE;
|
||||
|
||||
/* Strip off leading 'axi' command argument */
|
||||
argc--;
|
||||
argv++;
|
||||
|
||||
/* Hand off rest of command line to sub-commands */
|
||||
c = find_cmd_tbl(argv[0], &cmd_axi_sub[0], ARRAY_SIZE(cmd_axi_sub));
|
||||
|
||||
if (c)
|
||||
return c->cmd(cmdtp, flag, argc, argv);
|
||||
else
|
||||
return CMD_RET_USAGE;
|
||||
}
|
||||
|
||||
static char axi_help_text[] =
|
||||
"bus - show AXI bus info\n"
|
||||
"axi dev [bus] - show or set current AXI bus to bus number [bus]\n"
|
||||
"axi md size addr [# of objects] - read from AXI device at address [addr] and data width [size] (one of 8, 16, 32)\n"
|
||||
"axi mw size addr value [count] - write data [value] to AXI device at address [addr] and data width [size] (one of 8, 16, 32)\n";
|
||||
|
||||
U_BOOT_CMD(axi, 7, 1, do_ihs_axi,
|
||||
"AXI sub-system",
|
||||
axi_help_text
|
||||
);
|
||||
Loading…
Reference in a new issue