46 lines
1.2 KiB
C
46 lines
1.2 KiB
C
/* SPDX-License-Identifier: (GPL-2.0+ OR MIT) */
|
|
/*
|
|
* common/cmd_mem_mask.c
|
|
*
|
|
* Copyright (C) 2020 Amlogic, Inc. All rights reserved.
|
|
*
|
|
*/
|
|
|
|
/* mem write function with mask setting */
|
|
|
|
#include <common.h>
|
|
#include <command.h>
|
|
#include <watchdog.h>
|
|
#include <asm/io.h>
|
|
|
|
#define wr_reg(addr, data) writel(data, addr)
|
|
#define rd_reg(addr) readl(addr)
|
|
|
|
int do_mem_mw_mask(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
|
|
{
|
|
char *endp;
|
|
unsigned long reg_add=0;
|
|
unsigned int wr_reg_value=0;
|
|
unsigned int rd_reg_value=0;
|
|
unsigned int wr_reg_and_mask_1=0xffffffff;
|
|
if (argc < 4) {
|
|
//cmd_usage(cmdtp);
|
|
return -1;
|
|
}
|
|
reg_add = simple_strtoul(argv[1], &endp, 10);
|
|
wr_reg_value = simple_strtoul(argv[2], &endp, 10);
|
|
wr_reg_and_mask_1 = simple_strtoul(argv[3], &endp, 10);
|
|
rd_reg_value = (rd_reg(reg_add));
|
|
wr_reg(reg_add,(rd_reg_value&wr_reg_and_mask_1)|(wr_reg_value&(~wr_reg_and_mask_1)) );
|
|
printf("mwm 0x%lx:[0x%8x] with [0x%8x] ok\n", reg_add, rd_reg_value, rd_reg(reg_add));
|
|
return 0;
|
|
}
|
|
|
|
U_BOOT_CMD(
|
|
mwm, 30, 1, do_mem_mw_mask,
|
|
"mw mask function",
|
|
"[reg] [value] [mask]\n"
|
|
" //write [reg] with [value], skip [mask] bits\n"
|
|
"eg: mwm 0x01000000 0xaaaabbbb 0x0000ffff\n"
|
|
" then read 0x01000000 = 0xaaaaXXXX //skip mask bits\n"
|
|
); |