2 * Copyright (c) 2004 Hidetoshi Shimokawa <simokawa@FreeBSD.ORG>
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
27 #include <sys/cdefs.h>
28 __FBSDID("$FreeBSD$");
31 * FireWire disk device handling.
37 #include <machine/bootinfo.h>
41 #include <bootstrap.h>
45 #include <dev/dcons/dcons.h>
48 #define BIT4x2(x,y) uint8_t y:4, x:4
49 #define BIT16x2(x,y) uint32_t y:16, x:16
51 #include <dev/firewire/iec13213.h>
53 extern uint32_t dcons_paddr;
54 extern struct console dconsole;
58 struct crom_chunk root;
59 struct crom_chunk vendor;
62 struct crom_chunk unit;
63 struct crom_chunk spec;
64 struct crom_chunk ver;
67 static int fw_init(void);
68 static int fw_strategy(void *devdata, int flag, daddr_t dblk,
69 size_t size, char *buf, size_t *rsize);
70 static int fw_open(struct open_file *f, ...);
71 static int fw_close(struct open_file *f);
72 static int fw_print(int verbose);
73 static void fw_cleanup(void);
77 struct devsw fwohci = {
78 "FW1394", /* 7 chars at most */
89 static struct fwohci_softc fwinfo[MAX_OHCI];
90 static int fw_initialized = 0;
93 fw_probe(int index, struct fwohci_softc *sc)
97 sc->state = FWOHCI_STATE_INIT;
98 err = biospci_find_devclass(
99 0x0c0010 /* Serial:FireWire:OHCI */,
104 sc->state = FWOHCI_STATE_DEAD;
108 biospci_write_config(sc->locator,
110 0x6 /* enable bus master and memory mapped I/O */,
113 biospci_read_config(sc->locator, 0x00 /*devid*/, 2 /*dword*/,
115 biospci_read_config(sc->locator, 0x10 /*base_addr*/, 2 /*dword*/,
118 sc->handle = (uint32_t)PTOV(sc->base_addr);
119 sc->bus_id = OREAD(sc, OHCI_BUS_ID);
128 struct fwohci_softc *sc;
134 for (i = 0; i < MAX_OHCI; i ++) {
137 if (sc->state == FWOHCI_STATE_DEAD)
149 * Print information about OHCI chips
152 fw_print(int verbose)
156 struct fwohci_softc *sc;
158 printf("%s devices:", fwohci.dv_name);
159 if ((ret = pager_output("\n")) != 0)
162 for (i = 0; i < MAX_OHCI; i ++) {
164 if (sc->state == FWOHCI_STATE_DEAD)
166 snprintf(line, sizeof(line), "%d: locator=0x%04x devid=0x%08x"
167 " base_addr=0x%08x handle=0x%08x bus_id=0x%08x\n",
168 i, sc->locator, sc->devid,
169 sc->base_addr, sc->handle, sc->bus_id);
170 ret = pager_output(line);
178 fw_open(struct open_file *f, ...)
182 struct i386_devdesc *dev;
183 struct open_disk *od;
187 dev = va_arg(ap, struct i386_devdesc *);
195 fw_close(struct open_file *f)
203 struct dcons_buf *db;
205 /* invalidate dcons buffer */
207 db = (struct dcons_buf *)PTOV(dcons_paddr);
213 fw_strategy(void *devdata, int rw, daddr_t dblk, size_t size,
214 char *buf, size_t *rsize)
220 fw_init_crom(struct fwohci_softc *sc)
222 struct crom_src *src;
224 printf("fw_init_crom\n");
225 sc->crom_src_buf = (struct crom_src_buf *)
226 malloc(sizeof(struct crom_src_buf));
227 if (sc->crom_src_buf == NULL)
230 src = &sc->crom_src_buf->src;
231 bzero(src, sizeof(struct crom_src));
233 /* BUS info sample */
234 src->hdr.info_len = 4;
236 src->businfo.bus_name = CSR_BUS_NAME_IEEE1394;
238 src->businfo.irmc = 1;
239 src->businfo.cmc = 1;
240 src->businfo.isc = 1;
241 src->businfo.bmc = 1;
242 src->businfo.pmc = 0;
243 src->businfo.cyc_clk_acc = 100;
244 src->businfo.max_rec = sc->maxrec;
245 src->businfo.max_rom = MAXROM_4;
246 #define FW_GENERATION_CHANGEABLE 2
247 src->businfo.generation = FW_GENERATION_CHANGEABLE;
248 src->businfo.link_spd = sc->speed;
250 src->businfo.eui64.hi = sc->eui.hi;
251 src->businfo.eui64.lo = sc->eui.lo;
253 STAILQ_INIT(&src->chunk_list);
256 sc->crom_root = &sc->crom_src_buf->root;
260 fw_reset_crom(struct fwohci_softc *sc)
262 struct crom_src_buf *buf;
263 struct crom_src *src;
264 struct crom_chunk *root;
266 printf("fw_reset\n");
267 if (sc->crom_src_buf == NULL)
270 buf = sc->crom_src_buf;
272 root = sc->crom_root;
274 STAILQ_INIT(&src->chunk_list);
276 bzero(root, sizeof(struct crom_chunk));
277 crom_add_chunk(src, NULL, root, 0);
278 crom_add_entry(root, CSRKEY_NCAP, 0x0083c0); /* XXX */
279 /* private company_id */
280 crom_add_entry(root, CSRKEY_VENDOR, CSRVAL_VENDOR_PRIVATE);
282 crom_add_simple_text(src, root, &buf->vendor, "DragonFly Project");
284 crom_add_simple_text(src, root, &buf->vendor, "FreeBSD Project");
289 #define ADDR_HI(x) (((x) >> 24) & 0xffffff)
290 #define ADDR_LO(x) ((x) & 0xffffff)
293 dcons_crom(struct fwohci_softc *sc)
295 struct crom_src_buf *buf;
296 struct crom_src *src;
297 struct crom_chunk *root;
299 buf = sc->crom_src_buf;
301 root = sc->crom_root;
303 bzero(&buf->unit, sizeof(struct crom_chunk));
305 crom_add_chunk(src, root, &buf->unit, CROM_UDIR);
306 crom_add_entry(&buf->unit, CSRKEY_SPEC, CSRVAL_VENDOR_PRIVATE);
307 crom_add_simple_text(src, &buf->unit, &buf->spec, "FreeBSD");
308 crom_add_entry(&buf->unit, CSRKEY_VER, DCONS_CSR_VAL_VER);
309 crom_add_simple_text(src, &buf->unit, &buf->ver, "dcons");
310 crom_add_entry(&buf->unit, DCONS_CSR_KEY_HI, ADDR_HI(dcons_paddr));
311 crom_add_entry(&buf->unit, DCONS_CSR_KEY_LO, ADDR_LO(dcons_paddr));
315 fw_crom(struct fwohci_softc *sc)
317 struct crom_src *src;
323 newrom = malloc(CROMSIZE);
324 src = &sc->crom_src_buf->src;
325 crom_load(src, (uint32_t *)newrom, CROMSIZE);
326 if (bcmp(newrom, sc->config_rom, CROMSIZE) != 0) {
327 /* Bump generation and reload. */
328 src->businfo.generation++;
330 /* Handle generation count wraps. */
331 if (src->businfo.generation < 2)
332 src->businfo.generation = 2;
334 /* Recalculate CRC to account for generation change. */
335 crom_load(src, (uint32_t *)newrom, CROMSIZE);
336 bcopy(newrom, (void *)sc->config_rom, CROMSIZE);
342 fw_busreset(struct fwohci_softc *sc)
346 if (sc->state < FWOHCI_STATE_ENABLED) {
347 printf("fwohci not enabled\n");
353 while (sc->state< FWOHCI_STATE_NORMAL) {
357 printf("give up to wait bus initialize\n");
361 printf("poll count = %d\n", count);
368 struct fwohci_softc *sc;
371 if (fw_initialized == 0)
374 for (i = 0; i < MAX_OHCI; i ++) {
376 if (sc->state != FWOHCI_STATE_INIT)
379 sc->config_rom = (uint32_t *)
380 (((uint32_t)sc->config_rom_buf
381 + (CROMSIZE - 1)) & ~(CROMSIZE - 1));
383 printf("configrom: %08p %08p\n",
384 sc->config_rom_buf, sc->config_rom);
386 if (fwohci_init(sc, 0) == 0) {
387 sc->state = FWOHCI_STATE_ENABLED;
390 sc->state = FWOHCI_STATE_DEAD;
397 struct fwohci_softc *sc;
400 if (fw_initialized == 0)
403 for (i = 0; i < MAX_OHCI; i ++) {
405 if (sc->state < FWOHCI_STATE_ENABLED)
411 #if 0 /* for debug */
413 fw_busreset_cmd(int argc, char *argv[])
415 struct fwohci_softc *sc;
418 for (i = 0; i < MAX_OHCI; i ++) {
420 if (sc->state < FWOHCI_STATE_INIT)
428 fw_poll_cmd(int argc, char *argv[])
435 fw_enable_cmd(int argc, char *argv[])
444 dcons_enable(int argc, char *argv[])
448 dconsole.c_flags |= C_ACTIVEIN | C_ACTIVEOUT;
453 dcons_read(int argc, char *argv[])
456 while (dconsole.c_ready()) {
465 dcons_write(int argc, char *argv[])
471 len = strlen(argv[1]);
472 for (i = 0; i < len; i ++)
473 dconsole.c_out(argv[1][i]);
474 dconsole.c_out('\r');
475 dconsole.c_out('\n');
478 COMMAND_SET(firewire, "firewire", "enable firewire", fw_enable_cmd);
479 COMMAND_SET(fwbusreset, "fwbusreset", "firewire busreset", fw_busreset_cmd);
480 COMMAND_SET(fwpoll, "fwpoll", "firewire poll", fw_poll_cmd);
481 COMMAND_SET(dcons, "dcons", "enable dcons", dcons_enable);
482 COMMAND_SET(dread, "dread", "read from dcons", dcons_read);
483 COMMAND_SET(dwrite, "dwrite", "write to dcons", dcons_write);