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
|
/* $OpenBSD: omapid.c,v 1.3 2016/10/08 05:55:03 jsg Exp $ */
/*
* Copyright (c) 2013 Dale Rahn <drahn@dalerahn.com>
*
* Permission to use, copy, modify, and distribute this software for any
* purpose with or without fee is hereby granted, provided that the above
* copyright notice and this permission notice appear in all copies.
*
* THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
* WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
* MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
* ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
* WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
* ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
* OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
*/
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/queue.h>
#include <sys/malloc.h>
#include <sys/device.h>
#include <sys/evcount.h>
#include <sys/socket.h>
#include <sys/timeout.h>
#include <machine/intr.h>
#include <machine/bus.h>
#include <armv7/armv7/armv7var.h>
#include <dev/ofw/fdt.h>
/* registers */
#define O4_ID_SIZE 0x1000
#define O4_FUSE_ID0 0x200
#define O4_ID_CODE 0x204
#define O4_FUSE_ID1 0x208
#define O4_FUSE_ID2 0x20C
#define O4_FUSE_ID3 0x210
#define O4_FUSE_PRODID0 0x214
#define O4_FUSE_PRODID1 0x218
struct omapid_softc {
struct device sc_dev;
bus_space_tag_t sc_iot;
bus_space_handle_t sc_ioh;
};
struct omapid_softc *omapid_sc;
void omapid_attach(struct device *parent, struct device *self, void *args);
void omapid_wpending(int flags);
struct cfattach omapid_ca = {
sizeof (struct omapid_softc), NULL, omapid_attach
};
struct cfdriver omapid_cd = {
NULL, "omapid", DV_DULL
};
void amptimer_set_clockrate(int32_t new_frequency); /* XXX */
void
omapid_attach(struct device *parent, struct device *self, void *args)
{
struct armv7_attach_args *aa = args;
struct omapid_softc *sc = (struct omapid_softc *) self;
uint32_t rev;
uint32_t newclockrate = 0;
char *board;
void *node;
sc->sc_iot = aa->aa_iot;
if (bus_space_map(sc->sc_iot, aa->aa_dev->mem[0].addr,
aa->aa_dev->mem[0].size, 0, &sc->sc_ioh))
panic("omapid: bus_space_map failed!");
omapid_sc = sc;
node = fdt_find_node("/");
if (node == NULL)
panic("%s: could not get fdt root node",
sc->sc_dev.dv_xname);
board = "unknown";
if (fdt_is_compatible(node, "ti,omap4")) {
rev = bus_space_read_4(sc->sc_iot, sc->sc_ioh, O4_ID_CODE);
switch ((rev >> 12) & 0xffff) {
case 0xB852:
case 0xB95C:
board = "omap4430";
newclockrate = 400 * 1000 * 1000;
break;
case 0xB94E:
board = "omap4460";
newclockrate = 350 * 1000 * 1000;
break;
}
}
printf(": %s\n", board);
if (newclockrate != 0)
amptimer_set_clockrate(newclockrate);
}
|
