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
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
|
/*-
* Copyright (c) 2013 Ian Lepore <ian@freebsd.org>
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
*
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
* SUCH DAMAGE.
*/
#include "opt_platform.h"
#include <sys/cdefs.h>
__FBSDID("$FreeBSD$");
#define _ARM32_BUS_DMA_PRIVATE
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/reboot.h>
#include <vm/vm.h>
#include <vm/pmap.h>
#include <machine/armreg.h>
#include <machine/bus.h>
#include <machine/devmap.h>
#include <machine/machdep.h>
#include <arm/freescale/imx/imx_machdep.h>
#include <arm/freescale/imx/imx_wdogreg.h>
#define IMX_MAX_DEVMAP_ENTRIES 8
static struct pmap_devmap devmap_entries[IMX_MAX_DEVMAP_ENTRIES];
static u_int devmap_idx;
static vm_offset_t devmap_vaddr = ARM_VECTORS_HIGH;
void
imx_devmap_addentry(vm_paddr_t pa, vm_size_t sz)
{
struct pmap_devmap *m;
/*
* The last table entry is the all-zeroes end-of-table marker. If we're
* about to overwrite it the world is coming to an end. This code runs
* too early for the panic to be printed unless a special early-debug
* console is in use, but there's nothing else we can do.
*/
if (devmap_idx == (IMX_MAX_DEVMAP_ENTRIES - 1))
panic("IMX_MAX_DEVMAP_ENTRIES is too small!\n");
/*
* Allocate virtual address space from the top of kva downwards. If the
* range being mapped is aligned and sized to 1MB boundaries then also
* align the virtual address to the next-lower 1MB boundary so that we
* end up with a section mapping.
*/
if ((pa & 0x000fffff) == 0 && (sz & 0x000fffff) == 0) {
devmap_vaddr = (devmap_vaddr - sz) & ~0x000fffff;
} else {
devmap_vaddr = (devmap_vaddr - sz) & ~0x00000fff;
}
m = &devmap_entries[devmap_idx++];
m->pd_va = devmap_vaddr;
m->pd_pa = pa;
m->pd_size = sz;
m->pd_prot = VM_PROT_READ | VM_PROT_WRITE;
m->pd_cache = PTE_DEVICE;
}
vm_offset_t
initarm_lastaddr(void)
{
/* XXX - Get rid of this stuff soon. */
boothowto |= RB_VERBOSE|RB_MULTIPLE;
bootverbose = 1;
/*
* Normally initarm() calls platform_devmap_init() much later in the
* init process to set up static device mappings. To calculate the
* highest available kva address we have to do that setup first. It
* maps downwards from ARM_VECTORS_HIGH and the last usable kva address
* is the point right before the virtual address of the first static
* mapping. So go set up the static mapping table now, then we can
* return the lowest static devmap vaddr as the end of usable kva.
*/
imx_devmap_init();
pmap_devmap_bootstrap_table = devmap_entries;
return (devmap_vaddr);
}
int
platform_devmap_init(void)
{
/* On imx this work is done during initarm_lastaddr(). */
return (0);
}
/*
* Set initial values of GPIO output ports
*/
void
initarm_gpio_init(void)
{
}
void
initarm_late_init(void)
{
struct pmap_devmap *m;
/*
* We did the static devmap setup earlier, during initarm_lastaddr(),
* but now the console should be working and we can be verbose about
* what we did.
*/
if (bootverbose) {
for (m = devmap_entries; m->pd_va != 0; ++m) {
printf("Devmap: phys 0x%08x virt 0x%08x size %uK\n",
m->pd_pa, m->pd_va, m->pd_size / 1024);
}
}
}
struct arm32_dma_range *
bus_dma_get_range(void)
{
return (NULL);
}
int
bus_dma_get_range_nb(void)
{
return (0);
}
/*
* This code which manipulates the watchdog hardware is here to implement
* cpu_reset() because the watchdog is the only way for software to reset the
* chip. Why here and not in imx_wdog.c? Because there's no requirement that
* the watchdog driver be compiled in, but it's nice to be able to reboot even
* if it's not.
*/
void
imx_wdog_cpu_reset(vm_offset_t wdcr_physaddr)
{
volatile uint16_t * pcr;
/*
* The deceptively simple write of WDOG_CR_WDE enables the watchdog,
* sets the timeout to its minimum value (half a second), and also
* clears the SRS bit which results in the SFTW (software-requested
* reset) bit being set in the watchdog status register after the reset.
* This is how software can distinguish a reset from a wdog timeout.
*/
if ((pcr = arm_devmap_ptov(wdcr_physaddr, sizeof(*pcr))) == NULL) {
printf("cpu_reset() can't find its control register... locking up now.");
} else {
*pcr = WDOG_CR_WDE;
}
for (;;)
continue;
}
u_int
imx_soc_family(void)
{
return (imx_soc_type() >> IMXSOC_FAMSHIFT);
}
|
