mirror of
https://github.com/brain-hackers/u-boot-brain
synced 2024-08-15 06:33:45 +09:00
![Łukasz Majewski](/assets/img/avatar_default.png)
Lack of this check resulted in a data abort when CPU tried to execute the following command (without further mandatory input): 'pmic MAX77686_PMIC'. Only the 'pmic list' command requires one passed parameter. Other require at least two valid parameters for correct operation. Signed-off-by: Lukasz Majewski <l.majewski@samsung.com>
224 lines
4.1 KiB
C
224 lines
4.1 KiB
C
/*
|
|
* Copyright (C) 2011 Samsung Electronics
|
|
* Lukasz Majewski <l.majewski@samsung.com>
|
|
*
|
|
* (C) Copyright 2010
|
|
* Stefano Babic, DENX Software Engineering, sbabic@denx.de
|
|
*
|
|
* (C) Copyright 2008-2009 Freescale Semiconductor, Inc.
|
|
*
|
|
* SPDX-License-Identifier: GPL-2.0+
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <malloc.h>
|
|
#include <linux/types.h>
|
|
#include <linux/list.h>
|
|
#include <power/pmic.h>
|
|
|
|
static LIST_HEAD(pmic_list);
|
|
|
|
int check_reg(struct pmic *p, u32 reg)
|
|
{
|
|
if (reg >= p->number_of_regs) {
|
|
printf("<reg num> = %d is invalid. Should be less than %d\n",
|
|
reg, p->number_of_regs);
|
|
return -1;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int pmic_set_output(struct pmic *p, u32 reg, int out, int on)
|
|
{
|
|
u32 val;
|
|
|
|
if (pmic_reg_read(p, reg, &val))
|
|
return -1;
|
|
|
|
if (on)
|
|
val |= out;
|
|
else
|
|
val &= ~out;
|
|
|
|
if (pmic_reg_write(p, reg, val))
|
|
return -1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void pmic_show_info(struct pmic *p)
|
|
{
|
|
printf("PMIC: %s\n", p->name);
|
|
}
|
|
|
|
static int pmic_dump(struct pmic *p)
|
|
{
|
|
int i, ret;
|
|
u32 val;
|
|
|
|
if (!p) {
|
|
puts("Wrong PMIC name!\n");
|
|
return -1;
|
|
}
|
|
|
|
pmic_show_info(p);
|
|
for (i = 0; i < p->number_of_regs; i++) {
|
|
ret = pmic_reg_read(p, i, &val);
|
|
if (ret)
|
|
puts("PMIC: Registers dump failed\n");
|
|
|
|
if (!(i % 8))
|
|
printf("\n0x%02x: ", i);
|
|
|
|
printf("%08x ", val);
|
|
}
|
|
puts("\n");
|
|
return 0;
|
|
}
|
|
|
|
struct pmic *pmic_alloc(void)
|
|
{
|
|
struct pmic *p;
|
|
|
|
p = calloc(sizeof(*p), 1);
|
|
if (!p) {
|
|
printf("%s: No available memory for allocation!\n", __func__);
|
|
return NULL;
|
|
}
|
|
|
|
list_add_tail(&p->list, &pmic_list);
|
|
|
|
debug("%s: new pmic struct: 0x%p\n", __func__, p);
|
|
|
|
return p;
|
|
}
|
|
|
|
struct pmic *pmic_get(const char *s)
|
|
{
|
|
struct pmic *p;
|
|
|
|
list_for_each_entry(p, &pmic_list, list) {
|
|
if (strcmp(p->name, s) == 0) {
|
|
debug("%s: pmic %s -> 0x%p\n", __func__, p->name, p);
|
|
return p;
|
|
}
|
|
}
|
|
|
|
return NULL;
|
|
}
|
|
|
|
const char *power_get_interface(int interface)
|
|
{
|
|
const char *power_interface[] = {"I2C", "SPI", "|+|-|"};
|
|
return power_interface[interface];
|
|
}
|
|
|
|
static void pmic_list_names(void)
|
|
{
|
|
struct pmic *p;
|
|
|
|
puts("PMIC devices:\n");
|
|
list_for_each_entry(p, &pmic_list, list) {
|
|
printf("name: %s bus: %s_%d\n", p->name,
|
|
power_get_interface(p->interface), p->bus);
|
|
}
|
|
}
|
|
|
|
int do_pmic(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
|
|
{
|
|
u32 ret, reg, val;
|
|
char *cmd, *name;
|
|
struct pmic *p;
|
|
|
|
/* at least two arguments please */
|
|
if (argc < 2)
|
|
return CMD_RET_USAGE;
|
|
|
|
if (strcmp(argv[1], "list") == 0) {
|
|
pmic_list_names();
|
|
return CMD_RET_SUCCESS;
|
|
}
|
|
|
|
if (argc < 3)
|
|
return CMD_RET_USAGE;
|
|
|
|
name = argv[1];
|
|
cmd = argv[2];
|
|
|
|
debug("%s: name: %s cmd: %s\n", __func__, name, cmd);
|
|
p = pmic_get(name);
|
|
if (!p)
|
|
return CMD_RET_FAILURE;
|
|
|
|
if (strcmp(cmd, "dump") == 0) {
|
|
if (pmic_dump(p))
|
|
return CMD_RET_FAILURE;
|
|
return CMD_RET_SUCCESS;
|
|
}
|
|
|
|
if (strcmp(cmd, "read") == 0) {
|
|
if (argc < 4)
|
|
return CMD_RET_USAGE;
|
|
|
|
reg = simple_strtoul(argv[3], NULL, 16);
|
|
ret = pmic_reg_read(p, reg, &val);
|
|
|
|
if (ret)
|
|
puts("PMIC: Register read failed\n");
|
|
|
|
printf("\n0x%02x: 0x%08x\n", reg, val);
|
|
|
|
return CMD_RET_SUCCESS;
|
|
}
|
|
|
|
if (strcmp(cmd, "write") == 0) {
|
|
if (argc < 5)
|
|
return CMD_RET_USAGE;
|
|
|
|
reg = simple_strtoul(argv[3], NULL, 16);
|
|
val = simple_strtoul(argv[4], NULL, 16);
|
|
pmic_reg_write(p, reg, val);
|
|
|
|
return CMD_RET_SUCCESS;
|
|
}
|
|
|
|
if (strcmp(cmd, "bat") == 0) {
|
|
if (argc < 4)
|
|
return CMD_RET_USAGE;
|
|
|
|
if (!p->pbat) {
|
|
printf("%s is not a battery\n", p->name);
|
|
return CMD_RET_FAILURE;
|
|
}
|
|
|
|
if (strcmp(argv[3], "state") == 0)
|
|
p->fg->fg_battery_check(p->pbat->fg, p);
|
|
|
|
if (strcmp(argv[3], "charge") == 0) {
|
|
printf("BAT: %s charging (ctrl+c to break)\n",
|
|
p->name);
|
|
if (p->low_power_mode)
|
|
p->low_power_mode();
|
|
if (p->pbat->battery_charge)
|
|
p->pbat->battery_charge(p);
|
|
}
|
|
|
|
return CMD_RET_SUCCESS;
|
|
}
|
|
|
|
/* No subcommand found */
|
|
return CMD_RET_SUCCESS;
|
|
}
|
|
|
|
U_BOOT_CMD(
|
|
pmic, CONFIG_SYS_MAXARGS, 1, do_pmic,
|
|
"PMIC",
|
|
"list - list available PMICs\n"
|
|
"pmic name dump - dump named PMIC registers\n"
|
|
"pmic name read <reg> - read register\n"
|
|
"pmic name write <reg> <value> - write register\n"
|
|
"pmic name bat state - write register\n"
|
|
"pmic name bat charge - write register\n"
|
|
);
|