2 * Copyright (c) 2009 Yohanes Nugroho <yohanes@gmail.com>
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 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 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$");
30 #include <sys/param.h>
31 #include <sys/systm.h>
33 #include <sys/types.h>
34 #include <sys/kernel.h>
35 #include <sys/malloc.h>
36 #include <sys/module.h>
39 #include <vm/vm_kern.h>
41 #include <vm/vm_page.h>
42 #include <vm/vm_extern.h>
44 #define _ARM32_BUS_DMA_PRIVATE
45 #include <machine/bus.h>
46 #include <machine/intr.h>
47 #include <machine/resource.h>
49 #include "econa_reg.h"
50 #include "econa_var.h"
52 static struct econa_softc *econa_softc;
54 unsigned int CPU_clock = 200000000;
55 unsigned int AHB_clock;
56 unsigned int APB_clock;
59 bs_protos(generic_armv4);
61 struct bus_space econa_bs_tag = {
65 /* mapping/unmapping */
70 /* allocation/deallocation */
85 generic_armv4_bs_rm_2,
91 generic_armv4_bs_rr_2,
103 generic_armv4_bs_wm_2,
131 /* read (single) stream */
137 /* read multiple stream */
139 generic_armv4_bs_rm_2,
143 /* read region stream */
149 /* write (single) stream */
155 /* write multiple stream */
157 generic_armv4_bs_wm_2,
161 /* write region stream */
168 bus_space_tag_t obio_tag = &econa_bs_tag;
171 econa_probe(device_t dev)
174 device_set_desc(dev, "ECONA device bus");
179 econa_identify(driver_t *drv, device_t parent)
182 BUS_ADD_CHILD(parent, 0, "econaarm", 0);
185 struct arm32_dma_range *
186 bus_dma_get_range(void)
193 bus_dma_get_range_nb(void)
199 extern void irq_entry(void);
202 econa_add_child(device_t dev, int prio, const char *name, int unit,
203 bus_addr_t addr, bus_size_t size,
205 int irq2, int irq3, int irq4)
208 struct econa_ivar *ivar;
210 kid = device_add_child_ordered(dev, prio, name, unit);
212 printf("Can't add child %s%d ordered\n", name, unit);
215 ivar = malloc(sizeof(*ivar), M_DEVBUF, M_NOWAIT | M_ZERO);
217 device_delete_child(dev, kid);
220 device_set_ivars(kid, ivar);
221 resource_list_init(&ivar->resources);
223 bus_set_resource(kid, SYS_RES_IRQ, 0, irq0, 1);
225 bus_set_resource(kid, SYS_RES_IRQ, 1, irq1, 1);
227 bus_set_resource(kid, SYS_RES_IRQ, 2, irq2, 1);
229 bus_set_resource(kid, SYS_RES_IRQ, 3, irq3, 1);
231 bus_set_resource(kid, SYS_RES_IRQ, 4, irq4, 1);
234 bus_set_resource(kid, SYS_RES_MEMORY, 0, addr, size);
251 struct cpu_devs econarm_devs[] =
255 ECONA_IO_BASE + ECONA_PIC_BASE, ECONA_PIC_SIZE,
260 ECONA_IO_BASE + ECONA_SYSTEM_BASE, ECONA_SYSTEM_SIZE,
265 ECONA_IO_BASE + ECONA_UART_BASE, ECONA_UART_SIZE,
270 ECONA_IO_BASE + ECONA_TIMER_BASE, ECONA_TIMER_SIZE,
271 ECONA_IRQ_TIMER_1, ECONA_IRQ_TIMER_2
275 ECONA_OHCI_VBASE, ECONA_OHCI_SIZE,
280 ECONA_EHCI_VBASE, ECONA_EHCI_SIZE,
285 ECONA_CFI_VBASE, ECONA_CFI_SIZE,
290 ECONA_IO_BASE + ECONA_NET_BASE, ECONA_NET_SIZE,
292 ECONA_IRQ_TSTC, ECONA_IRQ_FSRC,
293 ECONA_IRQ_TSQE, ECONA_IRQ_FSQF,
295 { 0, 0, 0, 0, 0, 0, 0, 0, 0 }
299 econa_cpu_add_builtin_children(device_t dev, struct econa_softc *sc)
302 struct cpu_devs *walker;
304 for (i = 0, walker = econarm_devs; walker->name; i++, walker++) {
305 econa_add_child(dev, i, walker->name, walker->unit,
306 walker->mem_base, walker->mem_len,
307 walker->irq0,walker->irq1, walker->irq2,
308 walker->irq3, walker->irq4);
313 struct intc_trigger_t {
318 static struct intc_trigger_t intc_trigger_table[] = {
319 {INTC_EDGE_TRIGGER, INTC_RISING_EDGE},
320 {INTC_EDGE_TRIGGER, INTC_RISING_EDGE},
321 {INTC_EDGE_TRIGGER, INTC_FALLING_EDGE},
322 {INTC_EDGE_TRIGGER, INTC_RISING_EDGE},
323 {INTC_TRIGGER_UNKNOWN, INTC_TRIGGER_UNKNOWN},
324 {INTC_LEVEL_TRIGGER, INTC_ACTIVE_LOW},
325 {INTC_LEVEL_TRIGGER, INTC_ACTIVE_LOW},
326 {INTC_LEVEL_TRIGGER, INTC_ACTIVE_HIGH},
327 {INTC_TRIGGER_UNKNOWN, INTC_TRIGGER_UNKNOWN},
328 {INTC_LEVEL_TRIGGER, INTC_ACTIVE_HIGH},
329 {INTC_LEVEL_TRIGGER, INTC_ACTIVE_HIGH},
330 {INTC_LEVEL_TRIGGER, INTC_ACTIVE_HIGH},
331 {INTC_LEVEL_TRIGGER, INTC_ACTIVE_HIGH},
332 {INTC_TRIGGER_UNKNOWN, INTC_TRIGGER_UNKNOWN},
333 {INTC_LEVEL_TRIGGER, INTC_ACTIVE_HIGH},
334 {INTC_EDGE_TRIGGER, INTC_FALLING_EDGE},
335 {INTC_TRIGGER_UNKNOWN, INTC_TRIGGER_UNKNOWN},
336 {INTC_TRIGGER_UNKNOWN, INTC_TRIGGER_UNKNOWN},
337 {INTC_LEVEL_TRIGGER, INTC_ACTIVE_HIGH},
338 {INTC_EDGE_TRIGGER, INTC_RISING_EDGE},
339 {INTC_EDGE_TRIGGER, INTC_RISING_EDGE},
340 {INTC_EDGE_TRIGGER, INTC_RISING_EDGE},
341 {INTC_EDGE_TRIGGER, INTC_RISING_EDGE},
342 {INTC_LEVEL_TRIGGER, INTC_ACTIVE_LOW},
343 {INTC_LEVEL_TRIGGER, INTC_ACTIVE_LOW},
346 static inline uint32_t
347 read_4(struct econa_softc *sc, bus_size_t off)
350 return bus_space_read_4(sc->ec_st, sc->ec_sys_sh, off);
354 write_4(struct econa_softc *sc, bus_size_t off, uint32_t val)
357 return bus_space_write_4(sc->ec_st, sc->ec_sys_sh, off, val);
360 static inline uint32_t
361 system_read_4(struct econa_softc *sc, bus_size_t off)
364 return bus_space_read_4(sc->ec_st, sc->ec_system_sh, off);
368 system_write_4(struct econa_softc *sc, bus_size_t off, uint32_t val)
371 return bus_space_write_4(sc->ec_st, sc->ec_system_sh, off, val);
377 econa_set_irq_mode(struct econa_softc * sc, unsigned int irq,
382 if ((mode != INTC_LEVEL_TRIGGER) && (mode != INTC_EDGE_TRIGGER))
385 val = read_4(sc, INTC_INTERRUPT_TRIGGER_MODE_REG_OFFSET);
387 if (mode == INTC_LEVEL_TRIGGER) {
388 if (val & (1UL << irq)) {
389 val &= ~(1UL << irq);
390 write_4(sc, INTC_INTERRUPT_TRIGGER_MODE_REG_OFFSET,
394 if (!(val & (1UL << irq))) {
396 write_4(sc, INTC_INTERRUPT_TRIGGER_MODE_REG_OFFSET,
403 * Configure interrupt trigger level to be Active High/Low
404 * or Rising/Falling Edge
407 econa_set_irq_level(struct econa_softc * sc,
408 unsigned int irq, unsigned int level)
412 if ((level != INTC_ACTIVE_HIGH) &&
413 (level != INTC_ACTIVE_LOW) &&
414 (level != INTC_RISING_EDGE) &&
415 (level != INTC_FALLING_EDGE)) {
419 val = read_4(sc, INTC_INTERRUPT_TRIGGER_LEVEL_REG_OFFSET);
421 if ((level == INTC_ACTIVE_HIGH) || (level == INTC_RISING_EDGE)) {
422 if (val & (1UL << irq)) {
423 val &= ~(1UL << irq);
424 write_4(sc, INTC_INTERRUPT_TRIGGER_LEVEL_REG_OFFSET,
428 if (!(val & (1UL << irq))) {
430 write_4(sc, INTC_INTERRUPT_TRIGGER_LEVEL_REG_OFFSET,
437 get_system_clock(void)
439 uint32_t sclock = system_read_4(econa_softc, SYSTEM_CLOCK);
441 sclock = (sclock >> 6) & 0x03;
445 CPU_clock = 175000000;
448 CPU_clock = 200000000;
451 CPU_clock = 225000000;
454 CPU_clock = 250000000;
457 AHB_clock = CPU_clock >> 1;
458 APB_clock = AHB_clock >> 1;
462 econa_attach(device_t dev)
464 struct econa_softc *sc = device_get_softc(dev);
468 sc->ec_st = &econa_bs_tag;
469 sc->ec_sh = ECONA_IO_BASE;
471 if (bus_space_subregion(sc->ec_st, sc->ec_sh, ECONA_PIC_BASE,
472 ECONA_PIC_SIZE, &sc->ec_sys_sh) != 0)
473 panic("Unable to map IRQ registers");
475 if (bus_space_subregion(sc->ec_st, sc->ec_sh, ECONA_SYSTEM_BASE,
476 ECONA_SYSTEM_SIZE, &sc->ec_system_sh) != 0)
477 panic("Unable to map IRQ registers");
479 sc->ec_irq_rman.rm_type = RMAN_ARRAY;
480 sc->ec_irq_rman.rm_descr = "ECONA IRQs";
481 sc->ec_mem_rman.rm_type = RMAN_ARRAY;
482 sc->ec_mem_rman.rm_descr = "ECONA Memory";
483 if (rman_init(&sc->ec_irq_rman) != 0 ||
484 rman_manage_region(&sc->ec_irq_rman, 0, 31) != 0)
485 panic("econa_attach: failed to set up IRQ rman");
486 if (rman_init(&sc->ec_mem_rman) != 0 ||
487 rman_manage_region(&sc->ec_mem_rman, 0,
489 panic("econa_attach: failed to set up memory rman");
491 write_4(sc, INTC_INTERRUPT_CLEAR_EDGE_TRIGGER_REG_OFFSET, 0xffffffff);
493 write_4(sc, INTC_INTERRUPT_MASK_REG_OFFSET, 0xffffffff);
495 write_4(sc, INTC_FIQ_MODE_SELECT_REG_OFFSET, 0);
498 for (i = 0; i < 32; i++) {
499 if (intc_trigger_table[i].mode != INTC_TRIGGER_UNKNOWN) {
500 econa_set_irq_mode(sc,i, intc_trigger_table[i].mode);
501 econa_set_irq_level(sc, i, intc_trigger_table[i].level);
507 econa_cpu_add_builtin_children(dev, sc);
509 bus_generic_probe(dev);
510 bus_generic_attach(dev);
511 enable_interrupts(I32_bit | F32_bit);
516 static struct resource *
517 econa_alloc_resource(device_t dev, device_t child, int type, int *rid,
518 u_long start, u_long end, u_long count, u_int flags)
520 struct econa_softc *sc = device_get_softc(dev);
521 struct resource_list_entry *rle;
522 struct econa_ivar *ivar = device_get_ivars(child);
523 struct resource_list *rl = &ivar->resources;
525 if (device_get_parent(child) != dev)
526 return (BUS_ALLOC_RESOURCE(device_get_parent(dev), child,
527 type, rid, start, end, count, flags));
529 rle = resource_list_find(rl, type, *rid);
534 panic("Resource rid %d type %d already in use", *rid, type);
535 if (start == 0UL && end == ~0UL) {
537 count = ulmax(count, rle->count);
538 end = ulmax(rle->end, start + count - 1);
543 rle->res = rman_reserve_resource(&sc->ec_irq_rman,
544 start, end, count, flags, child);
547 rle->res = rman_reserve_resource(&sc->ec_mem_rman,
548 start, end, count, flags, child);
549 if (rle->res != NULL) {
550 rman_set_bustag(rle->res, &econa_bs_tag);
551 rman_set_bushandle(rle->res, start);
556 rle->start = rman_get_start(rle->res);
557 rle->end = rman_get_end(rle->res);
559 rman_set_rid(rle->res, *rid);
564 static struct resource_list *
565 econa_get_resource_list(device_t dev, device_t child)
567 struct econa_ivar *ivar;
568 ivar = device_get_ivars(child);
569 return (&(ivar->resources));
573 econa_release_resource(device_t dev, device_t child, int type,
574 int rid, struct resource *r)
576 struct resource_list *rl;
577 struct resource_list_entry *rle;
579 rl = econa_get_resource_list(dev, child);
582 rle = resource_list_find(rl, type, rid);
585 rman_release_resource(r);
591 econa_setup_intr(device_t dev, device_t child,
592 struct resource *ires, int flags, driver_filter_t *filt,
593 driver_intr_t *intr, void *arg, void **cookiep)
596 if (rman_get_start(ires) == ECONA_IRQ_SYSTEM && filt == NULL)
597 panic("All system interrupt ISRs must be FILTER");
599 BUS_SETUP_INTR(device_get_parent(dev), child, ires, flags, filt,
602 arm_unmask_irq(rman_get_start(ires));
608 econa_teardown_intr(device_t dev, device_t child, struct resource *res,
612 return (BUS_TEARDOWN_INTR(device_get_parent(dev), child, res, cookie));
616 econa_activate_resource(device_t bus, device_t child, int type, int rid,
620 return (rman_activate_resource(r));
624 econa_print_child(device_t dev, device_t child)
626 struct econa_ivar *ivars;
627 struct resource_list *rl;
630 ivars = device_get_ivars(child);
631 rl = &ivars->resources;
633 retval += bus_print_child_header(dev, child);
635 retval += resource_list_print_type(rl, "port", SYS_RES_IOPORT, "%#lx");
636 retval += resource_list_print_type(rl, "mem", SYS_RES_MEMORY, "%#lx");
637 retval += resource_list_print_type(rl, "irq", SYS_RES_IRQ, "%ld");
638 if (device_get_flags(dev))
639 retval += printf(" flags %#x", device_get_flags(dev));
641 retval += bus_print_child_footer(dev, child);
647 arm_mask_irq(uintptr_t nb)
651 value = read_4(econa_softc,INTC_INTERRUPT_MASK_REG_OFFSET) | 1<<nb;
652 write_4(econa_softc, INTC_INTERRUPT_MASK_REG_OFFSET, value);
656 arm_unmask_irq(uintptr_t nb)
660 value = read_4(econa_softc,
661 INTC_INTERRUPT_CLEAR_EDGE_TRIGGER_REG_OFFSET) | (1 << nb);
663 INTC_INTERRUPT_CLEAR_EDGE_TRIGGER_REG_OFFSET, value);
664 value = read_4(econa_softc, INTC_INTERRUPT_MASK_REG_OFFSET)& ~(1 << nb);
665 write_4(econa_softc, INTC_INTERRUPT_MASK_REG_OFFSET, value);
669 arm_get_next_irq(int x)
673 irq = read_4(econa_softc, INTC_INTERRUPT_STATUS_REG_OFFSET) &
674 ~(read_4(econa_softc, INTC_INTERRUPT_MASK_REG_OFFSET));
677 return (ffs(irq) - 1);
688 control = system_read_4(econa_softc, RESET_CONTROL);
689 control |= GLOBAL_RESET;
690 system_write_4(econa_softc, RESET_CONTROL, control);
691 control = system_read_4(econa_softc, RESET_CONTROL);
692 control &= (~(GLOBAL_RESET));
693 system_write_4(econa_softc, RESET_CONTROL, control);
700 power_on_network_interface(void)
705 cfg_reg = system_read_4(econa_softc, RESET_CONTROL);
706 cfg_reg |= NET_INTERFACE_RESET;
707 /* set reset bit to HIGH active; */
708 system_write_4(econa_softc, RESET_CONTROL, cfg_reg);
711 for (ii = 0; ii < 0xFFF; ii++)
713 /* set reset bit to LOW active; */
714 cfg_reg = system_read_4(econa_softc, RESET_CONTROL);
715 cfg_reg &= ~(NET_INTERFACE_RESET);
716 system_write_4(econa_softc, RESET_CONTROL, cfg_reg);
719 for (ii = 0; ii < 0xFFF; ii++)
721 cfg_reg = system_read_4(econa_softc, RESET_CONTROL);
722 cfg_reg |= NET_INTERFACE_RESET;
723 /* set reset bit to HIGH active; */
724 system_write_4(econa_softc, RESET_CONTROL, cfg_reg);
734 static device_method_t econa_methods[] = {
735 DEVMETHOD(device_probe, econa_probe),
736 DEVMETHOD(device_attach, econa_attach),
737 DEVMETHOD(device_identify, econa_identify),
738 DEVMETHOD(bus_alloc_resource, econa_alloc_resource),
739 DEVMETHOD(bus_setup_intr, econa_setup_intr),
740 DEVMETHOD(bus_teardown_intr, econa_teardown_intr),
741 DEVMETHOD(bus_activate_resource, econa_activate_resource),
742 DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource),
743 DEVMETHOD(bus_get_resource_list, econa_get_resource_list),
744 DEVMETHOD(bus_set_resource, bus_generic_rl_set_resource),
745 DEVMETHOD(bus_get_resource, bus_generic_rl_get_resource),
746 DEVMETHOD(bus_release_resource, econa_release_resource),
747 DEVMETHOD(bus_print_child, econa_print_child),
751 static driver_t econa_driver = {
754 sizeof(struct econa_softc),
756 static devclass_t econa_devclass;
758 DRIVER_MODULE(econaarm, nexus, econa_driver, econa_devclass, 0, 0);