blob: 833266f08b1e48a1a5b84e761ca69f833faf0d7f [file] [log] [blame]
// SPDX-License-Identifier: GPL-2.0
/*
* List, select, and deselect mux controllers on the fly.
*
* Copyright (c) 2020 Texas Instruments Inc.
* Author: Pratyush Yadav <p.yadav@ti.com>
*/
#include <common.h>
#include <command.h>
#include <errno.h>
#include <dm.h>
#include <dm/device_compat.h>
#include <mux.h>
#include <mux-internal.h>
#include <linux/err.h>
#include <dt-bindings/mux/mux.h>
#define COLUMN_SIZE 16
/*
* Print a member of a column. The total size of the text printed, including
* trailing whitespace, will always be COLUMN_SIZE.
*/
#define PRINT_COLUMN(fmt, args...) do { \
char buf[COLUMN_SIZE + 1]; \
snprintf(buf, COLUMN_SIZE + 1, fmt, ##args); \
printf("%-*s", COLUMN_SIZE, buf); \
} while (0)
/*
* Find a mux based on its device name in argv[1] and index in the chip in
* argv[2].
*/
static struct mux_control *cmd_mux_find(char *const argv[])
{
struct udevice *dev;
struct mux_chip *chip;
int ret;
unsigned long id;
ret = strict_strtoul(argv[2], 10, &id);
if (ret)
return ERR_PTR(ret);
ret = uclass_get_device_by_name(UCLASS_MUX, argv[1], &dev);
if (ret)
return ERR_PTR(ret);
chip = dev_get_uclass_priv(dev);
if (!chip)
return ERR_PTR(ret);
if (id >= chip->controllers)
return ERR_PTR(-EINVAL);
return &chip->mux[id];
}
/*
* Print the details of a mux. The columns printed correspond to: "Selected",
* "Current State", "Idle State", and "Num States".
*/
static void print_mux(struct mux_control *mux)
{
PRINT_COLUMN("%s", mux->in_use ? "yes" : "no");
if (mux->cached_state == MUX_IDLE_AS_IS)
PRINT_COLUMN("%s", "unknown");
else
PRINT_COLUMN("0x%x", mux->cached_state);
if (mux->idle_state == MUX_IDLE_AS_IS)
PRINT_COLUMN("%s", "as-is");
else if (mux->idle_state == MUX_IDLE_DISCONNECT)
PRINT_COLUMN("%s", "disconnect");
else
PRINT_COLUMN("0x%x", mux->idle_state);
PRINT_COLUMN("0x%x", mux->states);
printf("\n");
}
static int do_mux_list(struct cmd_tbl *cmdtp, int flag, int argc,
char *const argv[])
{
struct udevice *dev;
struct mux_chip *chip;
int j;
for (uclass_first_device(UCLASS_MUX, &dev);
dev;
uclass_next_device(&dev)) {
chip = dev_get_uclass_priv(dev);
if (!chip) {
dev_err(dev, "can't find mux chip\n");
continue;
}
printf("%s:\n", dev->name);
printf(" ");
PRINT_COLUMN("ID");
PRINT_COLUMN("Selected");
PRINT_COLUMN("Current State");
PRINT_COLUMN("Idle State");
PRINT_COLUMN("Num States");
printf("\n");
for (j = 0; j < chip->controllers; j++) {
printf(" ");
PRINT_COLUMN("%d", j);
print_mux(&chip->mux[j]);
}
printf("\n");
}
return 0;
}
static int do_mux_select(struct cmd_tbl *cmdtp, int flag, int argc,
char *const argv[])
{
struct mux_control *mux;
int ret;
unsigned long state;
if (argc != 4)
return CMD_RET_USAGE;
mux = cmd_mux_find(argv);
if (IS_ERR_OR_NULL(mux)) {
printf("Failed to find the specified mux\n");
return CMD_RET_FAILURE;
}
ret = strict_strtoul(argv[3], 16, &state);
if (ret) {
printf("Invalid state\n");
return CMD_RET_FAILURE;
}
ret = mux_control_select(mux, state);
if (ret) {
printf("Failed to select requested state\n");
return CMD_RET_FAILURE;
}
return CMD_RET_SUCCESS;
}
static int do_mux_deselect(struct cmd_tbl *cmdtp, int flag, int argc,
char *const argv[])
{
struct mux_control *mux;
int ret;
if (argc != 3)
return CMD_RET_USAGE;
mux = cmd_mux_find(argv);
if (IS_ERR_OR_NULL(mux)) {
printf("Failed to find the specified mux\n");
return CMD_RET_FAILURE;
}
ret = mux_control_deselect(mux);
if (ret) {
printf("Failed to deselect mux\n");
return CMD_RET_FAILURE;
}
return CMD_RET_SUCCESS;
}
static char mux_help_text[] =
"list - List all Muxes and their states\n"
"select <chip> <id> <state> - Select the given mux state\n"
"deselect <chip> <id> - Deselect the given mux and reset it to its idle state";
U_BOOT_CMD_WITH_SUBCMDS(mux, "List, select, and deselect muxes", mux_help_text,
U_BOOT_SUBCMD_MKENT(list, 1, 1, do_mux_list),
U_BOOT_SUBCMD_MKENT(select, 4, 0, do_mux_select),
U_BOOT_SUBCMD_MKENT(deselect, 3, 0, do_mux_deselect));