1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
|
/* 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"
);
|