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
|
/*-
* Copyright (c) 2016 Michael Zhilin <mizhka@gmail.com>
* 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,
* without modification.
* 2. Redistributions in binary form must reproduce at minimum a disclaimer
* similar to the "NO WARRANTY" disclaimer below ("Disclaimer") and any
* redistribution must be conditioned upon including a substantially
* similar Disclaimer requirement for further binary redistribution.
*
* NO WARRANTY
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
* ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
* LIMITED TO, THE IMPLIED WARRANTIES OF NONINFRINGEMENT, MERCHANTIBILITY
* AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL
* THE COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR 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 DAMAGES.
*/
#include <sys/cdefs.h>
__FBSDID("$FreeBSD$");
#include <sys/param.h>
#include <sys/kernel.h>
#include <sys/bus.h>
#include <sys/module.h>
#include <sys/systm.h>
#include <sys/errno.h>
#include <sys/rman.h>
#include <sys/stddef.h>
#include <machine/bus.h>
#include <machine/resource.h>
#include <dev/bhnd/bhnd.h>
#include <dev/bhnd/bhndvar.h>
#include <dev/bhnd/bhnd_ids.h>
#include "bcm_mipscore.h"
static const struct resource_spec mipscore_rspec[MIPSCORE_MAX_RSPEC] = {
{ SYS_RES_MEMORY, 0, RF_ACTIVE },
{ -1, -1, 0 }
};
#define MIPSCORE_DEV(_vendor, _core) \
BHND_DEVICE(_vendor, _core, NULL, NULL, BHND_DF_SOC)
struct bhnd_device mipscore_match[] = {
MIPSCORE_DEV(BCM, MIPS),
MIPSCORE_DEV(BCM, MIPS33),
MIPSCORE_DEV(MIPS, MIPS74K),
BHND_DEVICE_END
};
static int
mipscore_probe(device_t dev)
{
const struct bhnd_device *id;
id = bhnd_device_lookup(dev, mipscore_match, sizeof(mipscore_match[0]));
if (id == NULL)
return (ENXIO);
bhnd_set_default_core_desc(dev);
return (BUS_PROBE_DEFAULT);
}
static int
mipscore_attach(device_t dev)
{
struct mipscore_softc *sc;
struct resource *res;
uint32_t intmask;
uint16_t devid;
int error;
sc = device_get_softc(dev);
devid = bhnd_get_device(dev);
sc->devid = devid;
sc->dev = dev;
/* Allocate bus resources */
memcpy(sc->rspec, mipscore_rspec, sizeof(sc->rspec));
error = bhnd_alloc_resources(dev, sc->rspec, sc->res);
if (error)
return (error);
res = sc->res[0]->res;
if (res == NULL)
return (ENXIO);
if (devid == BHND_COREID_MIPS74K) {
intmask = (1 << 31);
/* Use intmask5 register to route the timer interrupt */
bus_write_4(res, offsetof(struct mipscore_regs, intmask[5]),
intmask);
}
return (0);
}
static device_method_t mipscore_methods[] = {
DEVMETHOD(device_probe, mipscore_probe),
DEVMETHOD(device_attach, mipscore_attach),
DEVMETHOD_END
};
devclass_t bhnd_mipscore_devclass;
DEFINE_CLASS_0(bhnd_mips, mipscore_driver, mipscore_methods,
sizeof(struct mipscore_softc));
EARLY_DRIVER_MODULE(bhnd_mips, bhnd, mipscore_driver,
bhnd_mipscore_devclass, 0, 0, BUS_PASS_CPU + BUS_PASS_ORDER_EARLY);
MODULE_VERSION(bhnd_mips, 1);
|
