huangcm
2025-02-28 b45e871a67cd1272e3da9ba5bd383f832b0f1824
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
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
// SPDX-License-Identifier: GPL-2.0+
/*
 * Copyright (C) 2015 Google, Inc
 */
 
#include <common.h>
#include <dm.h>
#include <mapmem.h>
#include <regmap.h>
#include <syscon.h>
#include <asm/test.h>
#include <dm/test.h>
#include <test/ut.h>
 
/* Base test of register maps */
static int dm_test_regmap_base(struct unit_test_state *uts)
{
   struct udevice *dev;
   struct regmap *map;
   ofnode node;
   int i;
 
   ut_assertok(uclass_get_device(UCLASS_SYSCON, 0, &dev));
   map = syscon_get_regmap(dev);
   ut_assertok_ptr(map);
   ut_asserteq(1, map->range_count);
   ut_asserteq(0x10, map->ranges[0].start);
   ut_asserteq(4, map->ranges[0].size);
   ut_asserteq(0x10, map_to_sysmem(regmap_get_range(map, 0)));
 
   ut_assertok(uclass_get_device(UCLASS_SYSCON, 1, &dev));
   map = syscon_get_regmap(dev);
   ut_assertok_ptr(map);
   ut_asserteq(4, map->range_count);
   ut_asserteq(0x20, map->ranges[0].start);
   for (i = 0; i < 4; i++) {
       const unsigned long addr = 0x20 + 8 * i;
 
       ut_asserteq(addr, map->ranges[i].start);
       ut_asserteq(5 + i, map->ranges[i].size);
       ut_asserteq(addr, map_to_sysmem(regmap_get_range(map, i)));
   }
 
   /* Check that we can't pretend a different device is a syscon */
   ut_assertok(uclass_get_device(UCLASS_I2C, 0, &dev));
   map = syscon_get_regmap(dev);
   ut_asserteq_ptr(ERR_PTR(-ENOEXEC), map);
 
   /* A different device can be a syscon by using Linux-compat API */
   node = ofnode_path("/syscon@2");
   ut_assert(ofnode_valid(node));
 
   map = syscon_node_to_regmap(node);
   ut_assertok_ptr(map);
   ut_asserteq(4, map->range_count);
   ut_asserteq(0x40, map->ranges[0].start);
   for (i = 0; i < 4; i++) {
       const unsigned long addr = 0x40 + 8 * i;
 
       ut_asserteq(addr, map->ranges[i].start);
       ut_asserteq(5 + i, map->ranges[i].size);
       ut_asserteq(addr, map_to_sysmem(regmap_get_range(map, i)));
   }
 
   return 0;
}
DM_TEST(dm_test_regmap_base, DM_TESTF_SCAN_PDATA | DM_TESTF_SCAN_FDT);
 
/* Test we can access a regmap through syscon */
static int dm_test_regmap_syscon(struct unit_test_state *uts)
{
   struct regmap *map;
 
   map = syscon_get_regmap_by_driver_data(SYSCON0);
   ut_assertok_ptr(map);
   ut_asserteq(1, map->range_count);
 
   map = syscon_get_regmap_by_driver_data(SYSCON1);
   ut_assertok_ptr(map);
   ut_asserteq(4, map->range_count);
 
   map = syscon_get_regmap_by_driver_data(SYSCON_COUNT);
   ut_asserteq_ptr(ERR_PTR(-ENODEV), map);
 
   ut_asserteq(0x10, map_to_sysmem(syscon_get_first_range(SYSCON0)));
   ut_asserteq(0x20, map_to_sysmem(syscon_get_first_range(SYSCON1)));
   ut_asserteq_ptr(ERR_PTR(-ENODEV),
           syscon_get_first_range(SYSCON_COUNT));
 
   return 0;
}
 
DM_TEST(dm_test_regmap_syscon, DM_TESTF_SCAN_PDATA | DM_TESTF_SCAN_FDT);
 
/* Read/Write/Modify test */
static int dm_test_regmap_rw(struct unit_test_state *uts)
{
   struct udevice *dev;
   struct regmap *map;
   uint reg;
 
   ut_assertok(uclass_get_device(UCLASS_SYSCON, 0, &dev));
   map = syscon_get_regmap(dev);
   ut_assertok_ptr(map);
 
   ut_assertok(regmap_write(map, 0, 0xcacafafa));
   ut_assertok(regmap_write(map, 3, 0x55aa2211));
 
   ut_assertok(regmap_read(map, 0, &reg));
   ut_assertok(regmap_read(map, 3, &reg));
 
   ut_assertok(regmap_update_bits(map, 0, 0xff00ff00, 0x55aa2211));
   ut_assertok(regmap_update_bits(map, 3, 0x00ff00ff, 0xcacafada));
 
   return 0;
}
 
DM_TEST(dm_test_regmap_rw, DM_TESTF_SCAN_PDATA | DM_TESTF_SCAN_FDT);