1
2
3
4
5
6
7#include <common.h>
8#include <command.h>
9#include <dm.h>
10#include <errno.h>
11#include <misc.h>
12#include <linux/time.h>
13#include <asm/io.h>
14
15struct altera_sysid_regs {
16 u32 id;
17 u32 timestamp;
18};
19
20struct altera_sysid_plat {
21 struct altera_sysid_regs *regs;
22};
23
24void display_sysid(void)
25{
26 struct udevice *dev;
27 u32 sysid[2];
28 struct tm t;
29 char asc[32];
30 time_t stamp;
31 int ret;
32
33
34 ret = uclass_first_device_err(UCLASS_MISC, &dev);
35 if (ret)
36 return;
37 ret = misc_read(dev, 0, &sysid, sizeof(sysid));
38 if (ret < 0)
39 return;
40
41 stamp = sysid[1];
42 localtime_r(&stamp, &t);
43 asctime_r(&t, asc);
44 printf("SYSID: %08x, %s", sysid[0], asc);
45}
46
47int do_sysid(struct cmd_tbl *cmdtp, int flag, int argc, char *const argv[])
48{
49 display_sysid();
50 return 0;
51}
52
53U_BOOT_CMD(
54 sysid, 1, 1, do_sysid,
55 "display Nios-II system id",
56 ""
57);
58
59static int altera_sysid_read(struct udevice *dev,
60 int offset, void *buf, int size)
61{
62 struct altera_sysid_plat *plat = dev_get_plat(dev);
63 struct altera_sysid_regs *const regs = plat->regs;
64 u32 *sysid = buf;
65
66 sysid[0] = readl(®s->id);
67 sysid[1] = readl(®s->timestamp);
68
69 return 0;
70}
71
72static int altera_sysid_of_to_plat(struct udevice *dev)
73{
74 struct altera_sysid_plat *plat = dev_get_plat(dev);
75
76 plat->regs = map_physmem(dev_read_addr(dev),
77 sizeof(struct altera_sysid_regs),
78 MAP_NOCACHE);
79
80 return 0;
81}
82
83static const struct misc_ops altera_sysid_ops = {
84 .read = altera_sysid_read,
85};
86
87static const struct udevice_id altera_sysid_ids[] = {
88 { .compatible = "altr,sysid-1.0" },
89 {}
90};
91
92U_BOOT_DRIVER(altera_sysid) = {
93 .name = "altera_sysid",
94 .id = UCLASS_MISC,
95 .of_match = altera_sysid_ids,
96 .of_to_plat = altera_sysid_of_to_plat,
97 .plat_auto = sizeof(struct altera_sysid_plat),
98 .ops = &altera_sysid_ops,
99};
100