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