mirror of
https://xff.cz/git/u-boot/
synced 2026-01-20 13:07:22 +01:00
d678a59d2d
When bringing in the series 'arm: dts: am62-beagleplay: Fix Beagleplay Ethernet"' I failed to notice that b4 noticed it was based on next and so took that as the base commit and merged that part of next to master. This reverts commitc8ffd1356d, reversing changes made to2ee6f3a5f7. Reported-by: Jonas Karlman <jonas@kwiboo.se> Signed-off-by: Tom Rini <trini@konsulko.com>
155 lines
2.8 KiB
C
155 lines
2.8 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
|
|
#include <common.h>
|
|
#include <command.h>
|
|
#include <env.h>
|
|
#include <hexdump.h>
|
|
#include <malloc.h>
|
|
#include <mapmem.h>
|
|
#include <linux/ctype.h>
|
|
|
|
enum {
|
|
OP_ID_XOR,
|
|
OP_ID_AND,
|
|
OP_ID_OR,
|
|
};
|
|
|
|
void write_to_env_var(char *varname, u8 *result, ulong len)
|
|
{
|
|
char *str_output;
|
|
char *str_ptr;
|
|
int i;
|
|
|
|
str_output = malloc(len * 2 + 1);
|
|
str_ptr = str_output;
|
|
|
|
for (i = 0; i < len; i++) {
|
|
sprintf(str_ptr, "%02x", result[i]);
|
|
str_ptr += 2;
|
|
}
|
|
*str_ptr = '\0';
|
|
env_set(varname, str_output);
|
|
|
|
free(str_output);
|
|
}
|
|
|
|
void read_from_env_var(char *varname, u8 *result)
|
|
{
|
|
char *str_value;
|
|
|
|
str_value = env_get(varname);
|
|
if (str_value)
|
|
hex2bin(result, str_value, strlen(str_value) / 2);
|
|
else
|
|
hex2bin(result, varname, strlen(varname) / 2);
|
|
}
|
|
|
|
void read_from_mem(ulong addr, u8 *result, ulong len)
|
|
{
|
|
u8 *src;
|
|
|
|
src = map_sysmem(addr, len);
|
|
memcpy(result, src, len);
|
|
unmap_sysmem(src);
|
|
}
|
|
|
|
void write_to_mem(char *varname, u8 *result, ulong len)
|
|
{
|
|
ulong addr;
|
|
u8 *buf;
|
|
|
|
addr = hextoul(varname, NULL);
|
|
buf = map_sysmem(addr, len);
|
|
memcpy(buf, result, len);
|
|
unmap_sysmem(buf);
|
|
}
|
|
|
|
static int do_binop(struct cmd_tbl *cmdtp, int flag, int argc,
|
|
char *const argv[])
|
|
{
|
|
ulong len;
|
|
u8 *result, *src1, *src2;
|
|
char *oparg, *lenarg, *src1arg, *src2arg, *destarg;
|
|
int i, op;
|
|
|
|
if (argc < 5)
|
|
return CMD_RET_USAGE;
|
|
|
|
oparg = argv[1];
|
|
lenarg = argv[2];
|
|
src1arg = argv[3];
|
|
src2arg = argv[4];
|
|
|
|
if (!strcmp(oparg, "xor"))
|
|
op = OP_ID_XOR;
|
|
else if (!strcmp(oparg, "or"))
|
|
op = OP_ID_OR;
|
|
else if (!strcmp(oparg, "and"))
|
|
op = OP_ID_AND;
|
|
else
|
|
return CMD_RET_USAGE;
|
|
|
|
len = dectoul(lenarg, NULL);
|
|
|
|
src1 = malloc(len);
|
|
src2 = malloc(len);
|
|
|
|
if (*src1arg == '*')
|
|
read_from_mem(hextoul(src1arg + 1, NULL), src1, len);
|
|
else
|
|
read_from_env_var(src1arg, src1);
|
|
|
|
if (*src2arg == '*')
|
|
read_from_mem(hextoul(src2arg + 1, NULL), src2, len);
|
|
else
|
|
read_from_env_var(src2arg, src2);
|
|
|
|
result = malloc(len);
|
|
|
|
switch (op) {
|
|
case OP_ID_XOR:
|
|
for (i = 0; i < len; i++)
|
|
result[i] = src1[i] ^ src2[i];
|
|
break;
|
|
case OP_ID_OR:
|
|
for (i = 0; i < len; i++)
|
|
result[i] = src1[i] | src2[i];
|
|
break;
|
|
case OP_ID_AND:
|
|
for (i = 0; i < len; i++)
|
|
result[i] = src1[i] & src2[i];
|
|
break;
|
|
}
|
|
|
|
if (argc == 5) {
|
|
for (i = 0; i < len; i++) {
|
|
printf("%02x ", result[i]);
|
|
if (i % 16 == 15)
|
|
puts("\n");
|
|
}
|
|
puts("\n");
|
|
|
|
goto exit;
|
|
}
|
|
|
|
destarg = argv[5];
|
|
|
|
if (*destarg == '*')
|
|
write_to_mem(destarg + 1, result, len); /* Skip asterisk */
|
|
else
|
|
write_to_env_var(destarg, result, len);
|
|
exit:
|
|
free(result);
|
|
free(src2);
|
|
free(src1);
|
|
|
|
return 0;
|
|
}
|
|
|
|
U_BOOT_CMD(
|
|
binop, 6, 1, do_binop,
|
|
"compute binary operation",
|
|
"op count [*]src1 [*]src2 [[*]dest]\n"
|
|
" - compute binary operation of data at/in src1 and\n src2 (either *memaddr, env var name or hex string)\n and store result in/at dest, where op is one of\n xor, or, and."
|
|
);
|