Home | History | Annotate | Line # | Download | only in hd64465
hd64465pcmcia.c revision 1.3.2.2
      1  1.3.2.2  nathanw /*	$NetBSD: hd64465pcmcia.c,v 1.3.2.2 2002/04/01 07:40:33 nathanw Exp $	*/
      2      1.1      uch 
      3      1.1      uch /*-
      4      1.1      uch  * Copyright (c) 2001, 2002 The NetBSD Foundation, Inc.
      5      1.1      uch  * All rights reserved.
      6      1.1      uch  *
      7      1.1      uch  * This code is derived from software contributed to The NetBSD Foundation
      8      1.1      uch  * by UCHIYAMA Yasushi.
      9      1.1      uch  *
     10      1.1      uch  * Redistribution and use in source and binary forms, with or without
     11      1.1      uch  * modification, are permitted provided that the following conditions
     12      1.1      uch  * are met:
     13      1.1      uch  * 1. Redistributions of source code must retain the above copyright
     14      1.1      uch  *    notice, this list of conditions and the following disclaimer.
     15      1.1      uch  * 2. Redistributions in binary form must reproduce the above copyright
     16      1.1      uch  *    notice, this list of conditions and the following disclaimer in the
     17      1.1      uch  *    documentation and/or other materials provided with the distribution.
     18      1.1      uch  * 3. All advertising materials mentioning features or use of this software
     19      1.1      uch  *    must display the following acknowledgement:
     20      1.1      uch  *        This product includes software developed by the NetBSD
     21      1.1      uch  *        Foundation, Inc. and its contributors.
     22      1.1      uch  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23      1.1      uch  *    contributors may be used to endorse or promote products derived
     24      1.1      uch  *    from this software without specific prior written permission.
     25      1.1      uch  *
     26      1.1      uch  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27      1.1      uch  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28      1.1      uch  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29      1.1      uch  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30      1.1      uch  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31      1.1      uch  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32      1.1      uch  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33      1.1      uch  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34      1.1      uch  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35      1.1      uch  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36      1.1      uch  * POSSIBILITY OF SUCH DAMAGE.
     37      1.1      uch  */
     38      1.1      uch 
     39      1.1      uch #include <sys/param.h>
     40      1.1      uch #include <sys/systm.h>
     41      1.1      uch #include <sys/device.h>
     42      1.1      uch #include <sys/malloc.h>
     43      1.1      uch #include <sys/kthread.h>
     44      1.1      uch #include <sys/boot_flag.h>
     45      1.1      uch 
     46      1.1      uch #include <uvm/uvm_extern.h>
     47      1.1      uch 
     48      1.1      uch #include <machine/bus.h>
     49      1.1      uch #include <machine/intr.h>
     50      1.1      uch 
     51      1.1      uch #include <dev/pcmcia/pcmciareg.h>
     52      1.1      uch #include <dev/pcmcia/pcmciavar.h>
     53      1.1      uch #include <dev/pcmcia/pcmciachip.h>
     54      1.1      uch 
     55      1.1      uch #include <sh3/bscreg.h>
     56      1.1      uch 
     57      1.1      uch #include <hpcsh/dev/hd64465/hd64465reg.h>
     58      1.1      uch #include <hpcsh/dev/hd64465/hd64465var.h>
     59  1.3.2.2  nathanw #include <hpcsh/dev/hd64465/hd64465intcreg.h>
     60      1.1      uch #include <hpcsh/dev/hd64461/hd64461pcmciareg.h>
     61      1.1      uch 
     62      1.1      uch #include "locators.h"
     63      1.1      uch 
     64      1.1      uch #ifdef	HD64465PCMCIA_DEBUG
     65      1.1      uch #define DPRINTF_ENABLE
     66      1.1      uch #define DPRINTF_DEBUG	hd64465pcmcia_debug
     67      1.1      uch #endif
     68      1.1      uch #include <machine/debug.h>
     69      1.1      uch 
     70      1.1      uch enum memory_window_16 {
     71      1.1      uch 	MEMWIN_16M_COMMON_0,
     72      1.1      uch 	MEMWIN_16M_COMMON_1,
     73      1.1      uch 	MEMWIN_16M_COMMON_2,
     74      1.1      uch 	MEMWIN_16M_COMMON_3,
     75      1.1      uch };
     76      1.1      uch #define MEMWIN_16M_MAX	4
     77      1.1      uch 
     78      1.1      uch enum hd64465pcmcia_event_type {
     79      1.1      uch 	EVENT_NONE,
     80      1.1      uch 	EVENT_INSERT,
     81      1.1      uch 	EVENT_REMOVE,
     82      1.1      uch };
     83      1.1      uch #define EVENT_QUEUE_MAX		5
     84      1.1      uch 
     85      1.1      uch struct hd64465pcmcia_softc; /* forward declaration */
     86      1.1      uch 
     87      1.1      uch struct hd64465pcmcia_window_cookie {
     88      1.1      uch 	bus_space_tag_t wc_tag;
     89      1.1      uch 	bus_space_handle_t wc_handle;
     90      1.1      uch 	int wc_size;
     91      1.1      uch 	int wc_window;
     92      1.1      uch };
     93      1.1      uch 
     94      1.1      uch struct hd64465pcmcia_channel {
     95      1.1      uch 	struct hd64465pcmcia_softc *ch_parent;
     96      1.1      uch 	struct device *ch_pcmcia;
     97      1.1      uch 	int ch_channel;
     98      1.1      uch 
     99      1.1      uch 	/* memory space */
    100      1.1      uch 	bus_space_tag_t ch_memt;
    101      1.1      uch 	bus_space_handle_t ch_memh;
    102      1.1      uch 	bus_addr_t ch_membase_addr;
    103      1.1      uch 	bus_size_t ch_memsize;
    104      1.1      uch 	bus_space_tag_t ch_cmemt[MEMWIN_16M_MAX];
    105      1.1      uch 
    106      1.1      uch 	/* I/O space */
    107      1.1      uch 	bus_space_tag_t ch_iot;
    108      1.1      uch 	bus_addr_t ch_iobase;
    109      1.1      uch 	bus_size_t ch_iosize;
    110      1.1      uch 
    111      1.1      uch 	/* card interrupt */
    112      1.1      uch 	int (*ch_ih_card_func)(void *);
    113      1.1      uch 	void *ch_ih_card_arg;
    114      1.1      uch 	int ch_attached;
    115      1.1      uch };
    116      1.1      uch 
    117      1.1      uch struct hd64465pcmcia_event {
    118      1.1      uch 	int __queued;
    119      1.1      uch 	enum hd64465pcmcia_event_type pe_type;
    120      1.1      uch 	struct hd64465pcmcia_channel *pe_ch;
    121      1.1      uch 	SIMPLEQ_ENTRY(hd64465pcmcia_event) pe_link;
    122      1.1      uch };
    123      1.1      uch 
    124      1.1      uch struct hd64465pcmcia_softc {
    125      1.1      uch 	struct device sc_dev;
    126      1.1      uch 	enum hd64465_module_id sc_module_id;
    127      1.1      uch 	int sc_shutdown;
    128      1.1      uch 
    129      1.1      uch 	/* kv mapped Area 5, 6 */
    130      1.1      uch 	vaddr_t sc_area5;
    131      1.1      uch 	vaddr_t sc_area6;
    132      1.1      uch 
    133      1.1      uch 	/* CSC event */
    134      1.1      uch 	struct proc *sc_event_thread;
    135      1.1      uch 	struct hd64465pcmcia_event sc_event_pool[EVENT_QUEUE_MAX];
    136      1.1      uch 	SIMPLEQ_HEAD (, hd64465pcmcia_event) sc_event_head;
    137      1.1      uch 
    138      1.1      uch 	struct hd64465pcmcia_channel sc_ch[2];
    139      1.1      uch };
    140      1.1      uch 
    141      1.1      uch STATIC int hd64465pcmcia_chip_mem_alloc(pcmcia_chipset_handle_t, bus_size_t,
    142      1.1      uch     struct pcmcia_mem_handle *);
    143      1.1      uch STATIC void hd64465pcmcia_chip_mem_free(pcmcia_chipset_handle_t,
    144      1.1      uch     struct pcmcia_mem_handle *);
    145      1.1      uch STATIC int hd64465pcmcia_chip_mem_map(pcmcia_chipset_handle_t, int, bus_addr_t,
    146      1.1      uch     bus_size_t, struct pcmcia_mem_handle *, bus_size_t *, int *);
    147      1.1      uch STATIC void hd64465pcmcia_chip_mem_unmap(pcmcia_chipset_handle_t, int);
    148      1.1      uch STATIC int hd64465pcmcia_chip_io_alloc(pcmcia_chipset_handle_t, bus_addr_t,
    149      1.1      uch     bus_size_t, bus_size_t, struct pcmcia_io_handle *);
    150      1.1      uch STATIC void hd64465pcmcia_chip_io_free(pcmcia_chipset_handle_t,
    151      1.1      uch     struct pcmcia_io_handle *);
    152      1.1      uch STATIC int hd64465pcmcia_chip_io_map(pcmcia_chipset_handle_t, int, bus_addr_t,
    153      1.1      uch     bus_size_t, struct pcmcia_io_handle *, int *);
    154      1.1      uch STATIC void hd64465pcmcia_chip_io_unmap(pcmcia_chipset_handle_t, int);
    155      1.1      uch STATIC void hd64465pcmcia_chip_socket_enable(pcmcia_chipset_handle_t);
    156      1.1      uch STATIC void hd64465pcmcia_chip_socket_disable(pcmcia_chipset_handle_t);
    157      1.1      uch STATIC void *hd64465pcmcia_chip_intr_establish(pcmcia_chipset_handle_t,
    158      1.1      uch     struct pcmcia_function *, int, int (*)(void *), void *);
    159      1.1      uch STATIC void hd64465pcmcia_chip_intr_disestablish(pcmcia_chipset_handle_t,
    160      1.1      uch     void *);
    161      1.1      uch 
    162      1.1      uch STATIC struct pcmcia_chip_functions hd64465pcmcia_functions = {
    163      1.1      uch 	hd64465pcmcia_chip_mem_alloc,
    164      1.1      uch 	hd64465pcmcia_chip_mem_free,
    165      1.1      uch 	hd64465pcmcia_chip_mem_map,
    166      1.1      uch 	hd64465pcmcia_chip_mem_unmap,
    167      1.1      uch 	hd64465pcmcia_chip_io_alloc,
    168      1.1      uch 	hd64465pcmcia_chip_io_free,
    169      1.1      uch 	hd64465pcmcia_chip_io_map,
    170      1.1      uch 	hd64465pcmcia_chip_io_unmap,
    171      1.1      uch 	hd64465pcmcia_chip_intr_establish,
    172      1.1      uch 	hd64465pcmcia_chip_intr_disestablish,
    173      1.1      uch 	hd64465pcmcia_chip_socket_enable,
    174      1.1      uch 	hd64465pcmcia_chip_socket_disable,
    175      1.1      uch };
    176      1.1      uch 
    177      1.1      uch STATIC int hd64465pcmcia_match(struct device *, struct cfdata *, void *);
    178      1.1      uch STATIC void hd64465pcmcia_attach(struct device *, struct device *, void *);
    179      1.1      uch STATIC int hd64465pcmcia_print(void *, const char *);
    180      1.1      uch STATIC int hd64465pcmcia_submatch(struct device *, struct cfdata *, void *);
    181      1.1      uch 
    182      1.1      uch struct cfattach hd64465pcmcia_ca = {
    183      1.1      uch 	sizeof(struct hd64465pcmcia_softc), hd64465pcmcia_match,
    184      1.1      uch 	hd64465pcmcia_attach
    185      1.1      uch };
    186      1.1      uch 
    187      1.1      uch STATIC void hd64465pcmcia_attach_channel(struct hd64465pcmcia_softc *, int);
    188      1.1      uch /* hot plug */
    189      1.1      uch STATIC void hd64465pcmcia_create_event_thread(void *);
    190      1.1      uch STATIC void hd64465pcmcia_event_thread(void *);
    191      1.2      uch STATIC void __queue_event(struct hd64465pcmcia_channel *,
    192      1.1      uch     enum hd64465pcmcia_event_type);
    193      1.1      uch /* interrupt handler */
    194      1.1      uch STATIC int hd64465pcmcia_intr(void *);
    195      1.1      uch /* card status */
    196      1.2      uch STATIC enum hd64465pcmcia_event_type __detect_card(int);
    197      1.1      uch STATIC void hd64465pcmcia_memory_window16_switch(int,  enum memory_window_16);
    198      1.1      uch /* bus width */
    199      1.1      uch STATIC void __sh_set_bus_width(int, int);
    200      1.1      uch /* bus space access */
    201      1.1      uch STATIC int __sh_hd64465_map(vaddr_t, paddr_t, size_t, u_int32_t);
    202      1.1      uch STATIC vaddr_t __sh_hd64465_map_2page(paddr_t);
    203      1.1      uch 
    204      1.1      uch #define DELAY_MS(x)	delay((x) * 1000)
    205      1.1      uch 
    206      1.1      uch int
    207      1.1      uch hd64465pcmcia_match(struct device *parent, struct cfdata *cf, void *aux)
    208      1.1      uch {
    209      1.1      uch 	struct hd64465_attach_args *ha = aux;
    210      1.1      uch 
    211      1.1      uch 	return (ha->ha_module_id == HD64465_MODULE_PCMCIA);
    212      1.1      uch }
    213      1.1      uch 
    214      1.1      uch void
    215      1.1      uch hd64465pcmcia_attach(struct device *parent, struct device *self, void *aux)
    216      1.1      uch {
    217      1.1      uch 	struct hd64465_attach_args *ha = aux;
    218      1.1      uch 	struct hd64465pcmcia_softc *sc = (struct hd64465pcmcia_softc *)self;
    219      1.1      uch 
    220      1.1      uch 	sc->sc_module_id = ha->ha_module_id;
    221      1.1      uch 
    222      1.1      uch 	printf("\n");
    223      1.1      uch 
    224      1.1      uch 	sc->sc_area5 = __sh_hd64465_map_2page(0x14000000); /* area 5 */
    225      1.1      uch 	sc->sc_area6 = __sh_hd64465_map_2page(0x18000000); /* area 6 */
    226      1.1      uch 
    227      1.1      uch 	if (sc->sc_area5 == NULL || sc->sc_area6 == NULL) {
    228      1.1      uch 		printf("%s: can't map memory.\n", sc->sc_dev.dv_xname);
    229      1.1      uch 		if (sc->sc_area5)
    230      1.1      uch 			uvm_km_free(kernel_map, sc->sc_area5, 0x03000000);
    231      1.1      uch 		if (sc->sc_area6)
    232      1.1      uch 			uvm_km_free(kernel_map, sc->sc_area6, 0x03000000);
    233      1.1      uch 
    234      1.1      uch 		return;
    235      1.1      uch 	}
    236      1.1      uch 
    237      1.1      uch 	/* Channel 0/1 common CSC event queue */
    238      1.1      uch 	SIMPLEQ_INIT (&sc->sc_event_head);
    239      1.1      uch 	kthread_create(hd64465pcmcia_create_event_thread, sc);
    240      1.1      uch 
    241      1.1      uch 	hd64465pcmcia_attach_channel(sc, 0);
    242      1.1      uch 	hd64465pcmcia_attach_channel(sc, 1);
    243      1.1      uch }
    244      1.1      uch 
    245      1.1      uch void
    246      1.1      uch hd64465pcmcia_create_event_thread(void *arg)
    247      1.1      uch {
    248      1.1      uch 	struct hd64465pcmcia_softc *sc = arg;
    249      1.1      uch 	int error;
    250      1.1      uch 
    251      1.1      uch 	error = kthread_create1(hd64465pcmcia_event_thread, sc,
    252      1.1      uch 	    &sc->sc_event_thread, "%s", sc->sc_dev.dv_xname);
    253      1.1      uch 
    254      1.1      uch 	KASSERT(error == 0);
    255      1.1      uch }
    256      1.1      uch 
    257      1.1      uch void
    258      1.1      uch hd64465pcmcia_event_thread(void *arg)
    259      1.1      uch {
    260      1.1      uch 	struct hd64465pcmcia_softc *sc = arg;
    261      1.1      uch 	struct hd64465pcmcia_event *pe;
    262      1.1      uch 	int s;
    263      1.1      uch 
    264      1.1      uch 	while (!sc->sc_shutdown) {
    265      1.1      uch 		tsleep(sc, PWAIT, "CSC wait", 0);
    266      1.1      uch 		s = splhigh();
    267      1.1      uch 		while ((pe = SIMPLEQ_FIRST(&sc->sc_event_head))) {
    268      1.1      uch 			splx(s);
    269      1.1      uch 			switch (pe->pe_type) {
    270      1.1      uch 			default:
    271      1.1      uch 				printf("%s: unknown event.\n", __FUNCTION__);
    272      1.1      uch 				break;
    273      1.1      uch 			case EVENT_INSERT:
    274      1.1      uch 				DPRINTF("insert event.\n");
    275      1.1      uch 				pcmcia_card_attach(pe->pe_ch->ch_pcmcia);
    276      1.1      uch 				break;
    277      1.1      uch 			case EVENT_REMOVE:
    278      1.1      uch 				DPRINTF("remove event.\n");
    279      1.1      uch 				pcmcia_card_detach(pe->pe_ch->ch_pcmcia,
    280      1.1      uch 				    DETACH_FORCE);
    281      1.1      uch 				break;
    282      1.1      uch 			}
    283      1.1      uch 			s = splhigh();
    284      1.1      uch 			SIMPLEQ_REMOVE_HEAD(&sc->sc_event_head, pe, pe_link);
    285      1.1      uch 			pe->__queued = 0;
    286      1.1      uch 		}
    287      1.1      uch 		splx(s);
    288      1.1      uch 	}
    289      1.1      uch 	/* NOTREACHED */
    290      1.1      uch }
    291      1.1      uch 
    292      1.1      uch int
    293      1.1      uch hd64465pcmcia_print(void *arg, const char *pnp)
    294      1.1      uch {
    295      1.1      uch 
    296      1.1      uch 	if (pnp)
    297      1.1      uch 		printf("pcmcia at %s", pnp);
    298      1.1      uch 
    299      1.1      uch 	return (UNCONF);
    300      1.1      uch }
    301      1.1      uch 
    302      1.1      uch int
    303      1.1      uch hd64465pcmcia_submatch(struct device *parent, struct cfdata *cf, void *aux)
    304      1.1      uch {
    305      1.1      uch 	struct pcmciabus_attach_args *paa = aux;
    306      1.1      uch 	struct hd64465pcmcia_channel *ch =
    307      1.1      uch 	    (struct hd64465pcmcia_channel *)paa->pch;
    308      1.1      uch 
    309      1.1      uch 	if (ch->ch_channel == 0) {
    310      1.1      uch 		if (cf->cf_loc[PCMCIABUSCF_CONTROLLER] !=
    311      1.1      uch 		    PCMCIABUSCF_CONTROLLER_DEFAULT &&
    312      1.1      uch 		    cf->cf_loc[PCMCIABUSCF_CONTROLLER] != 0)
    313      1.1      uch 			return 0;
    314      1.1      uch 	} else {
    315      1.1      uch 		if (cf->cf_loc[PCMCIABUSCF_CONTROLLER] !=
    316      1.1      uch 		    PCMCIABUSCF_CONTROLLER_DEFAULT &&
    317      1.1      uch 		    cf->cf_loc[PCMCIABUSCF_CONTROLLER] != 1)
    318      1.1      uch 			return 0;
    319      1.1      uch 	}
    320      1.1      uch 	paa->pct = (pcmcia_chipset_tag_t)&hd64465pcmcia_functions;
    321      1.1      uch 
    322      1.1      uch 	return ((*cf->cf_attach->ca_match)(parent, cf, aux));
    323      1.1      uch }
    324      1.1      uch 
    325      1.1      uch void
    326      1.1      uch hd64465pcmcia_attach_channel(struct hd64465pcmcia_softc *sc, int channel)
    327      1.1      uch {
    328      1.1      uch 	struct device *parent = (struct device *)sc;
    329      1.1      uch 	struct hd64465pcmcia_channel *ch = &sc->sc_ch[channel];
    330      1.1      uch 	struct pcmciabus_attach_args paa;
    331      1.1      uch 	bus_addr_t baseaddr;
    332      1.1      uch 	u_int8_t r;
    333      1.1      uch 	int i;
    334      1.1      uch 
    335      1.1      uch 	ch->ch_parent = sc;
    336      1.1      uch 	ch->ch_channel = channel;
    337      1.1      uch 
    338      1.1      uch 	/*
    339      1.1      uch 	 * Continuous 16-MB Area Mode
    340      1.1      uch 	 */
    341      1.1      uch 	/* set Continuous 16-MB Area Mode */
    342      1.1      uch 	r = hd64465_reg_read_1(HD64461_PCCGCR(channel));
    343      1.1      uch 	r &= ~HD64461_PCCGCR_MMOD;
    344      1.1      uch 	r |= HD64461_PCCGCR_MMOD_16M;
    345      1.1      uch 	hd64465_reg_write_1(HD64461_PCCGCR(channel), r);
    346      1.1      uch 
    347      1.1      uch 	/* Attibute/Common memory extent */
    348      1.1      uch 	baseaddr = (channel == 0) ? sc->sc_area6 : sc->sc_area5;
    349      1.1      uch 
    350      1.1      uch 	ch->ch_memt = bus_space_create(0, "PCMCIA attribute memory",
    351      1.1      uch 	    baseaddr, 0x01000000); /* 16MB */
    352      1.1      uch 	bus_space_alloc(ch->ch_memt, 0, 0x00ffffff, 0x0001000,
    353      1.1      uch 	    0x1000, 0x1000, 0, &ch->ch_membase_addr, &ch->ch_memh);
    354      1.1      uch 
    355      1.1      uch 	/* Common memory space extent */
    356      1.1      uch 	ch->ch_memsize = 0x01000000;
    357      1.1      uch 	for (i = 0; i < MEMWIN_16M_MAX; i++) {
    358      1.1      uch 		ch->ch_cmemt[i] = bus_space_create(0, "PCMCIA common memory",
    359      1.1      uch 		    baseaddr + 0x01000000, ch->ch_memsize);
    360      1.1      uch 	}
    361      1.1      uch 
    362      1.1      uch 	/* I/O port extent */
    363      1.1      uch 	ch->ch_iobase = 0;
    364      1.1      uch 	ch->ch_iosize = 0x01000000;
    365      1.1      uch 	ch->ch_iot = bus_space_create(0, "PCMCIA I/O port",
    366      1.1      uch 	    baseaddr + 0x01000000 * 2, ch->ch_iosize);
    367      1.1      uch 
    368      1.1      uch 	/* Interrupt */
    369  1.3.2.2  nathanw 	hd64465_intr_establish(channel ? HD64465_PCC1 : HD64465_PCC0,
    370  1.3.2.2  nathanw 	    IST_LEVEL, IPL_TTY, hd64465pcmcia_intr, ch);
    371      1.1      uch 
    372      1.1      uch 	paa.paa_busname = "pcmcia";
    373      1.1      uch 	paa.pch = (pcmcia_chipset_handle_t)ch;
    374      1.1      uch 	paa.iobase = ch->ch_iobase;
    375      1.1      uch 	paa.iosize = ch->ch_iosize;
    376      1.1      uch 
    377      1.1      uch 	ch->ch_pcmcia = config_found_sm(parent, &paa, hd64465pcmcia_print,
    378      1.1      uch 	    hd64465pcmcia_submatch);
    379      1.1      uch 
    380      1.2      uch 	if (ch->ch_pcmcia && (__detect_card(ch->ch_channel) == EVENT_INSERT)) {
    381      1.1      uch 		ch->ch_attached = 1;
    382      1.1      uch 		pcmcia_card_attach(ch->ch_pcmcia);
    383      1.1      uch 	}
    384      1.1      uch }
    385      1.1      uch 
    386      1.1      uch int
    387      1.1      uch hd64465pcmcia_intr(void *arg)
    388      1.1      uch {
    389      1.1      uch 	struct hd64465pcmcia_channel *ch = (struct hd64465pcmcia_channel *)arg;
    390      1.1      uch 	u_int32_t cscr;
    391      1.1      uch 	u_int8_t r;
    392      1.1      uch 	int ret = 0;
    393      1.1      uch 
    394      1.1      uch 	cscr = HD64461_PCCCSCR(ch->ch_channel);
    395      1.1      uch 	r = hd64465_reg_read_1(cscr);
    396      1.1      uch 
    397      1.1      uch 	/* clear interrtupt (don't change power switch select) */
    398      1.1      uch 	hd64465_reg_write_1(cscr, r & ~0x40);
    399      1.1      uch 
    400      1.1      uch 	if (r & (0x60 | 0x04/* for memory mapped mode*/)) {
    401      1.1      uch 		if (ch->ch_ih_card_func) {
    402      1.1      uch 			ret = (*ch->ch_ih_card_func)(ch->ch_ih_card_arg);
    403      1.1      uch 		} else {
    404      1.1      uch 			DPRINTF("spurious IREQ interrupt.\n");
    405      1.1      uch 		}
    406      1.1      uch 	}
    407      1.1      uch 
    408      1.1      uch 	if (r & HD64461_PCC0CSCR_P0CDC)
    409      1.2      uch 		__queue_event(ch, __detect_card(ch->ch_channel));
    410      1.1      uch 
    411      1.1      uch 	return (ret);
    412      1.1      uch }
    413      1.1      uch 
    414      1.1      uch void
    415      1.2      uch __queue_event(struct hd64465pcmcia_channel *ch,
    416      1.1      uch     enum hd64465pcmcia_event_type type)
    417      1.1      uch {
    418      1.1      uch 	struct hd64465pcmcia_event *pe, *pool;
    419      1.1      uch 	struct hd64465pcmcia_softc *sc = ch->ch_parent;
    420      1.1      uch 	int i;
    421      1.1      uch 	int s = splhigh();
    422      1.1      uch 
    423      1.1      uch 	if (type == EVENT_NONE)
    424      1.1      uch 		goto out;
    425      1.1      uch 
    426      1.1      uch 	pe = 0;
    427      1.1      uch 	pool = sc->sc_event_pool;
    428      1.1      uch 	for (i = 0; i < EVENT_QUEUE_MAX; i++) {
    429      1.1      uch 		if (!pool[i].__queued) {
    430      1.1      uch 			pe = &pool[i];
    431      1.1      uch 			break;
    432      1.1      uch 		}
    433      1.1      uch 	}
    434      1.1      uch 
    435      1.1      uch 	if (pe == 0) {
    436      1.1      uch 		printf("%s: event FIFO overflow (max %d).\n", __FUNCTION__,
    437      1.1      uch 		    EVENT_QUEUE_MAX);
    438      1.1      uch 		goto out;
    439      1.1      uch 	}
    440      1.1      uch 
    441      1.1      uch 	if ((ch->ch_attached && (type == EVENT_INSERT)) ||
    442      1.1      uch 	    (!ch->ch_attached && (type == EVENT_REMOVE))) {
    443      1.1      uch 		DPRINTF("spurious CSC interrupt.\n");
    444      1.1      uch 		goto out;
    445      1.1      uch 	}
    446      1.1      uch 
    447      1.1      uch 	ch->ch_attached = (type == EVENT_INSERT);
    448      1.1      uch 	pe->__queued = 1;
    449      1.1      uch 	pe->pe_type = type;
    450      1.1      uch 	pe->pe_ch = ch;
    451      1.1      uch 	SIMPLEQ_INSERT_TAIL(&sc->sc_event_head, pe, pe_link);
    452      1.1      uch 	wakeup(sc);
    453      1.1      uch  out:
    454      1.1      uch 	splx(s);
    455      1.1      uch }
    456      1.1      uch 
    457      1.1      uch /*
    458      1.1      uch  * Interface for pcmcia driver.
    459      1.1      uch  */
    460      1.1      uch /*
    461      1.1      uch  * Interrupt.
    462      1.1      uch  */
    463      1.1      uch void *
    464      1.1      uch hd64465pcmcia_chip_intr_establish(pcmcia_chipset_handle_t pch,
    465      1.1      uch     struct pcmcia_function *pf, int ipl, int (*ih_func)(void *), void *ih_arg)
    466      1.1      uch {
    467      1.1      uch 	struct hd64465pcmcia_channel *ch = (struct hd64465pcmcia_channel *)pch;
    468      1.1      uch 	int channel = ch->ch_channel;
    469      1.1      uch 	bus_addr_t cscier = HD64461_PCCCSCIER(channel);
    470      1.1      uch 	u_int8_t r;
    471      1.1      uch 	int s = splhigh();
    472      1.1      uch 
    473  1.3.2.2  nathanw 	hd6446x_intr_priority(ch->ch_channel == 0 ? HD64465_PCC0 : HD64465_PCC1,
    474  1.3.2.2  nathanw 	    ipl);
    475  1.3.2.2  nathanw 
    476      1.1      uch 	ch->ch_ih_card_func = ih_func;
    477      1.1      uch 	ch->ch_ih_card_arg = ih_arg;
    478      1.1      uch 
    479      1.1      uch 	/* Enable card interrupt */
    480      1.1      uch 	r = hd64465_reg_read_1(cscier);
    481      1.1      uch 	/* set level mode */
    482      1.1      uch 	r &= ~HD64461_PCC0CSCIER_P0IREQE_MASK;
    483      1.1      uch 	r |= HD64461_PCC0CSCIER_P0IREQE_LEVEL;
    484      1.1      uch 	hd64465_reg_write_1(cscier, r);
    485      1.1      uch 
    486      1.1      uch 	splx(s);
    487      1.1      uch 
    488      1.1      uch 	return (void *)ih_func;
    489      1.1      uch }
    490      1.1      uch 
    491      1.1      uch void
    492      1.1      uch hd64465pcmcia_chip_intr_disestablish(pcmcia_chipset_handle_t pch, void *ih)
    493      1.1      uch {
    494      1.1      uch 	struct hd64465pcmcia_channel *ch = (struct hd64465pcmcia_channel *)pch;
    495      1.1      uch 	int channel = ch->ch_channel;
    496      1.1      uch 	bus_addr_t cscier = HD64461_PCCCSCIER(channel);
    497      1.1      uch 	int s = splhigh();
    498      1.1      uch 	u_int8_t r;
    499      1.1      uch 
    500  1.3.2.2  nathanw 	hd6446x_intr_priority(ch->ch_channel == 0 ? HD64465_PCC0 : HD64465_PCC1,
    501  1.3.2.2  nathanw 	    IPL_TTY);
    502  1.3.2.2  nathanw 
    503      1.1      uch 	/* Disable card interrupt */
    504      1.1      uch 	r = hd64465_reg_read_1(cscier);
    505      1.1      uch 	r &= ~HD64461_PCC0CSCIER_P0IREQE_MASK;
    506      1.1      uch 	r |= HD64461_PCC0CSCIER_P0IREQE_NONE;
    507      1.1      uch 	hd64465_reg_write_1(cscier, r);
    508      1.1      uch 
    509      1.1      uch 	ch->ch_ih_card_func = 0;
    510      1.1      uch 
    511      1.1      uch 	splx(s);
    512      1.1      uch }
    513      1.1      uch 
    514      1.1      uch /*
    515      1.1      uch  * Bus resources.
    516      1.1      uch  */
    517      1.1      uch int
    518      1.1      uch hd64465pcmcia_chip_mem_alloc(pcmcia_chipset_handle_t pch, bus_size_t size,
    519      1.1      uch     struct pcmcia_mem_handle *pcmhp)
    520      1.1      uch {
    521      1.1      uch 	struct hd64465pcmcia_channel *ch = (struct hd64465pcmcia_channel *)pch;
    522      1.1      uch 
    523      1.1      uch 	pcmhp->memt = ch->ch_memt;
    524      1.1      uch 	pcmhp->addr = ch->ch_membase_addr;
    525      1.1      uch 	pcmhp->memh = ch->ch_memh;
    526      1.1      uch 	pcmhp->size = size;
    527      1.1      uch 	pcmhp->realsize = size;
    528      1.1      uch 
    529      1.1      uch 	DPRINTF("base 0x%08lx size %#lx\n", pcmhp->addr, size);
    530      1.1      uch 
    531      1.1      uch 	return (0);
    532      1.1      uch }
    533      1.1      uch 
    534      1.1      uch void
    535      1.1      uch hd64465pcmcia_chip_mem_free(pcmcia_chipset_handle_t pch,
    536      1.1      uch     struct pcmcia_mem_handle *pcmhp)
    537      1.1      uch {
    538      1.1      uch 	/* NO-OP */
    539      1.1      uch }
    540      1.1      uch 
    541      1.1      uch int
    542      1.1      uch hd64465pcmcia_chip_mem_map(pcmcia_chipset_handle_t pch, int kind,
    543      1.1      uch     bus_addr_t card_addr, bus_size_t size, struct pcmcia_mem_handle *pcmhp,
    544      1.1      uch     bus_size_t *offsetp, int *windowp)
    545      1.1      uch {
    546      1.1      uch 	struct hd64465pcmcia_channel *ch = (struct hd64465pcmcia_channel *)pch;
    547      1.1      uch 	struct hd64465pcmcia_window_cookie *cookie;
    548      1.1      uch 	bus_addr_t ofs;
    549      1.1      uch 
    550      1.1      uch 	cookie = malloc(sizeof(struct hd64465pcmcia_window_cookie),
    551      1.1      uch 	    M_DEVBUF, M_NOWAIT);
    552      1.1      uch 	KASSERT(cookie);
    553      1.1      uch 	memset(cookie, 0, sizeof(struct hd64465pcmcia_window_cookie));
    554      1.1      uch 
    555      1.1      uch 	/* Address */
    556      1.1      uch 	if ((kind & ~PCMCIA_WIDTH_MEM_MASK) == PCMCIA_MEM_ATTR) {
    557      1.1      uch 		cookie->wc_tag = ch->ch_memt;
    558      1.1      uch 		if (bus_space_subregion(ch->ch_memt, ch->ch_memh, card_addr,
    559      1.1      uch 		    size, &cookie->wc_handle) != 0)
    560      1.1      uch 			goto bad;
    561      1.1      uch 
    562      1.1      uch 		*offsetp = card_addr;
    563      1.1      uch 		cookie->wc_window = -1;
    564      1.1      uch 	} else {
    565      1.1      uch 		int window = card_addr / ch->ch_memsize;
    566      1.1      uch 		KASSERT(window < MEMWIN_16M_MAX);
    567      1.1      uch 
    568      1.1      uch 		cookie->wc_tag = ch->ch_cmemt[window];
    569      1.1      uch 		ofs = card_addr - window * ch->ch_memsize;
    570      1.1      uch 		if (bus_space_map(cookie->wc_tag, ofs, size, 0,
    571      1.1      uch 		    &cookie->wc_handle) != 0)
    572      1.1      uch 			goto bad;
    573      1.1      uch 
    574      1.1      uch 		/* XXX bogus. check window per common memory access. */
    575      1.1      uch 		hd64465pcmcia_memory_window16_switch(ch->ch_channel, window);
    576      1.1      uch 		*offsetp = ofs + 0x01000000; /* skip attribute area */
    577      1.1      uch 		cookie->wc_window = window;
    578      1.1      uch 	}
    579      1.1      uch 	cookie->wc_size = size;
    580      1.1      uch 	*windowp = (int)cookie;
    581      1.1      uch 
    582      1.1      uch 	DPRINTF("(%s) %#lx+%#lx-> %#lx+%#lx\n", kind == PCMCIA_MEM_ATTR ?
    583      1.1      uch 	    "attribute" : "common", ch->ch_memh, card_addr, *offsetp, size);
    584      1.1      uch 
    585      1.1      uch 	return (0);
    586      1.1      uch  bad:
    587      1.1      uch 	DPRINTF("%#lx-%#lx map failed.\n", card_addr, size);
    588      1.1      uch 	free(cookie, M_DEVBUF);
    589      1.1      uch 
    590      1.1      uch 	return (1);
    591      1.1      uch }
    592      1.1      uch 
    593      1.1      uch void
    594      1.1      uch hd64465pcmcia_chip_mem_unmap(pcmcia_chipset_handle_t pch, int window)
    595      1.1      uch {
    596      1.1      uch 	struct hd64465pcmcia_window_cookie *cookie = (void *)window;
    597      1.1      uch 
    598      1.1      uch 	if (cookie->wc_window != -1)
    599      1.1      uch 		bus_space_unmap(cookie->wc_tag, cookie->wc_handle,
    600      1.1      uch 		    cookie->wc_size);
    601      1.1      uch 	DPRINTF("%#lx-%#x\n", cookie->wc_handle, cookie->wc_size);
    602      1.1      uch 	free(cookie, M_DEVBUF);
    603      1.1      uch }
    604      1.1      uch 
    605      1.1      uch int
    606      1.1      uch hd64465pcmcia_chip_io_alloc(pcmcia_chipset_handle_t pch, bus_addr_t start,
    607      1.1      uch     bus_size_t size, bus_size_t align, struct pcmcia_io_handle *pcihp)
    608      1.1      uch {
    609      1.1      uch 	struct hd64465pcmcia_channel *ch = (struct hd64465pcmcia_channel *)pch;
    610      1.1      uch 
    611      1.1      uch 	if (start) {
    612      1.1      uch 		if (bus_space_map(ch->ch_iot, start, size, 0, &pcihp->ioh)) {
    613      1.1      uch 			DPRINTF("couldn't map %#lx+%#lx\n", start, size);
    614      1.1      uch 			return (1);
    615      1.1      uch 		}
    616      1.1      uch 		pcihp->addr = pcihp->ioh;
    617      1.1      uch 		DPRINTF("map %#lx+%#lx\n", start, size);
    618      1.1      uch 	} else {
    619      1.1      uch 		if (bus_space_alloc(ch->ch_iot, ch->ch_iobase,
    620      1.1      uch 		    ch->ch_iobase + ch->ch_iosize - 1,
    621      1.1      uch 		    size, align, 0, 0, &pcihp->addr, &pcihp->ioh)) {
    622      1.1      uch 			DPRINTF("couldn't allocate %#lx\n", size);
    623      1.1      uch 			return (1);
    624      1.1      uch 		}
    625      1.1      uch 		pcihp->flags = PCMCIA_IO_ALLOCATED;
    626      1.1      uch 	}
    627      1.1      uch 	DPRINTF("%#lx from %#lx\n", size, pcihp->addr);
    628      1.1      uch 
    629      1.1      uch 	pcihp->iot = ch->ch_iot;
    630      1.1      uch 	pcihp->size = size;
    631      1.1      uch 
    632      1.1      uch 	return (0);
    633      1.1      uch }
    634      1.1      uch 
    635      1.1      uch int
    636      1.1      uch hd64465pcmcia_chip_io_map(pcmcia_chipset_handle_t pch, int width,
    637      1.1      uch     bus_addr_t offset, bus_size_t size, struct pcmcia_io_handle *pcihp,
    638      1.1      uch     int *windowp)
    639      1.1      uch {
    640      1.1      uch 	struct hd64465pcmcia_channel *ch = (struct hd64465pcmcia_channel *)pch;
    641      1.1      uch #ifdef HD64465PCMCIA_DEBUG
    642      1.1      uch 	static const char *width_names[] = { "auto", "io8", "io16" };
    643      1.1      uch #endif
    644      1.1      uch 
    645      1.1      uch 	__sh_set_bus_width(ch->ch_channel, width);
    646      1.1      uch 
    647      1.1      uch 	DPRINTF("%#lx:%#lx+%#lx %s\n", pcihp->ioh, offset, size,
    648      1.1      uch 	    width_names[width]);
    649      1.1      uch 
    650      1.1      uch 	return (0);
    651      1.1      uch }
    652      1.1      uch 
    653      1.1      uch void
    654      1.1      uch hd64465pcmcia_chip_io_free(pcmcia_chipset_handle_t pch,
    655      1.1      uch     struct pcmcia_io_handle *pcihp)
    656      1.1      uch {
    657      1.1      uch 
    658      1.1      uch 	if (pcihp->flags & PCMCIA_IO_ALLOCATED)
    659      1.1      uch 		bus_space_free(pcihp->iot, pcihp->ioh, pcihp->size);
    660      1.1      uch 	else
    661      1.1      uch 		bus_space_unmap(pcihp->iot, pcihp->ioh, pcihp->size);
    662      1.1      uch 
    663      1.1      uch 	DPRINTF("%#lx+%#lx\n", pcihp->ioh, pcihp->size);
    664      1.1      uch }
    665      1.1      uch 
    666      1.1      uch void
    667      1.1      uch hd64465pcmcia_chip_io_unmap(pcmcia_chipset_handle_t pch, int window)
    668      1.1      uch {
    669      1.1      uch 	/* nothing to do */
    670      1.1      uch }
    671      1.1      uch 
    672      1.1      uch /*
    673      1.1      uch  * Enable/Disable
    674      1.1      uch  */
    675      1.1      uch void
    676      1.1      uch hd64465pcmcia_chip_socket_enable(pcmcia_chipset_handle_t pch)
    677      1.1      uch {
    678      1.1      uch 	struct hd64465pcmcia_channel *ch = (struct hd64465pcmcia_channel *)pch;
    679      1.1      uch 	int channel = ch->ch_channel;
    680      1.1      uch 	bus_addr_t isr, gcr;
    681      1.1      uch 	u_int8_t r;
    682      1.1      uch 	int cardtype;
    683      1.1      uch 
    684      1.1      uch 	DPRINTF("enable channel %d\n", channel);
    685      1.1      uch 	isr = HD64461_PCCISR(channel);
    686      1.1      uch 	gcr = HD64461_PCCGCR(channel);
    687      1.1      uch 
    688      1.1      uch 	/* Set Common memory area #0. */
    689      1.1      uch 	hd64465pcmcia_memory_window16_switch(channel, MEMWIN_16M_COMMON_0);
    690      1.1      uch 
    691      1.1      uch 	/* Set the card type */
    692      1.1      uch 	cardtype = pcmcia_card_gettype(ch->ch_pcmcia);
    693      1.1      uch 
    694      1.1      uch 	r = hd64465_reg_read_1(gcr);
    695      1.1      uch 	if (cardtype == PCMCIA_IFTYPE_IO)
    696      1.1      uch 		r |= HD64461_PCC0GCR_P0PCCT;
    697      1.1      uch 	else
    698      1.1      uch 		r &= ~HD64461_PCC0GCR_P0PCCT;
    699      1.1      uch 	hd64465_reg_write_1(gcr, r);
    700      1.1      uch 
    701      1.1      uch 	DPRINTF("OK.\n");
    702      1.1      uch }
    703      1.1      uch 
    704      1.1      uch void
    705      1.1      uch hd64465pcmcia_chip_socket_disable(pcmcia_chipset_handle_t pch)
    706      1.1      uch {
    707      1.1      uch 	struct hd64465pcmcia_channel *ch = (struct hd64465pcmcia_channel *)pch;
    708      1.1      uch 	int channel = ch->ch_channel;
    709      1.1      uch 
    710      1.1      uch 	/* dont' disable CSC interrupt */
    711      1.1      uch 	hd64465_reg_write_1(HD64461_PCCCSCIER(channel), HD64461_PCCCSCIER_CDE);
    712      1.1      uch 	hd64465_reg_write_1(HD64461_PCCCSCR(channel), 0);
    713      1.1      uch }
    714      1.1      uch 
    715      1.1      uch /*
    716      1.1      uch  * Card detect
    717      1.1      uch  */
    718      1.1      uch enum hd64465pcmcia_event_type
    719      1.2      uch __detect_card(int channel)
    720      1.1      uch {
    721      1.1      uch 	u_int8_t r;
    722      1.1      uch 
    723      1.1      uch 	r = hd64465_reg_read_1(HD64461_PCCISR(channel)) &
    724      1.1      uch 	    (HD64461_PCCISR_CD2 | HD64461_PCCISR_CD1);
    725      1.1      uch 
    726      1.1      uch 	if (r == (HD64461_PCCISR_CD2 | HD64461_PCCISR_CD1)) {
    727      1.1      uch 		DPRINTF("remove\n");
    728      1.1      uch 		return EVENT_REMOVE;
    729      1.1      uch 	}
    730      1.1      uch 	if (r == 0) {
    731      1.1      uch 		DPRINTF("insert\n");
    732      1.1      uch 		return EVENT_INSERT;
    733      1.1      uch 	}
    734      1.1      uch 	DPRINTF("transition\n");
    735      1.1      uch 
    736      1.1      uch 	return (EVENT_NONE);
    737      1.1      uch }
    738      1.1      uch 
    739      1.1      uch /*
    740      1.1      uch  * Memory window access ops.
    741      1.1      uch  */
    742      1.1      uch void
    743      1.1      uch hd64465pcmcia_memory_window16_switch(int channel, enum memory_window_16 window)
    744      1.1      uch {
    745      1.1      uch 	bus_addr_t a = HD64461_PCCGCR(channel);
    746      1.1      uch 	u_int8_t r;
    747      1.1      uch 
    748      1.1      uch 	r = hd64465_reg_read_1(a);
    749      1.1      uch 	r &= ~(HD64461_PCCGCR_PA25 | HD64461_PCCGCR_PA24);
    750      1.1      uch 
    751      1.1      uch 	switch (window) {
    752      1.1      uch 	case MEMWIN_16M_COMMON_0:
    753      1.1      uch 		break;
    754      1.1      uch 	case MEMWIN_16M_COMMON_1:
    755      1.1      uch 		r |= HD64461_PCCGCR_PA24;
    756      1.1      uch 		break;
    757      1.1      uch 	case MEMWIN_16M_COMMON_2:
    758      1.1      uch 		r |= HD64461_PCCGCR_PA25;
    759      1.1      uch 		break;
    760      1.1      uch 	case MEMWIN_16M_COMMON_3:
    761      1.1      uch 		r |= (HD64461_PCCGCR_PA25 | HD64461_PCCGCR_PA24);
    762      1.1      uch 		break;
    763      1.1      uch 	}
    764      1.1      uch 
    765      1.1      uch 	hd64465_reg_write_1(a, r);
    766      1.1      uch }
    767      1.1      uch 
    768      1.1      uch /*
    769      1.1      uch  * SH interface.
    770      1.1      uch  */
    771      1.1      uch void
    772      1.1      uch __sh_set_bus_width(int channel, int width)
    773      1.1      uch {
    774      1.1      uch 	u_int16_t r16;
    775      1.1      uch 
    776      1.2      uch 	r16 = _reg_read_2(SH4_BCR2);
    777      1.1      uch #ifdef HD64465PCMCIA_DEBUG
    778      1.1      uch 	dbg_bit_print_msg(r16, "BCR2");
    779      1.1      uch #endif
    780      1.1      uch 	if (channel == 0) {
    781      1.1      uch 		r16 &= ~((1 << 13)|(1 << 12));
    782      1.1      uch 		r16 |= 1 << (width == PCMCIA_WIDTH_IO8 ? 12 : 13);
    783      1.1      uch 	} else {
    784      1.1      uch 		r16 &= ~((1 << 11)|(1 << 10));
    785      1.1      uch 		r16 |= 1 << (width == PCMCIA_WIDTH_IO8 ? 10 : 11);
    786      1.1      uch 	}
    787      1.2      uch 	_reg_write_2(SH4_BCR2, r16);
    788      1.1      uch }
    789      1.1      uch 
    790      1.1      uch vaddr_t
    791      1.1      uch __sh_hd64465_map_2page(paddr_t pa)
    792      1.1      uch {
    793      1.1      uch 	static const u_int32_t mode[] =
    794      1.1      uch 	{ _PG_PCMCIA_ATTR16, _PG_PCMCIA_MEM16, _PG_PCMCIA_IO };
    795      1.1      uch 	vaddr_t va, v;
    796      1.1      uch 	int i;
    797      1.1      uch 
    798      1.1      uch 	/* allocate kernel virtual */
    799      1.1      uch 	v = va = uvm_km_valloc(kernel_map, 0x03000000);
    800      1.1      uch 	if (va == NULL) {
    801      1.1      uch 		PRINTF("can't allocate virtual for paddr 0x%08x\n",
    802      1.1      uch 		    (unsigned)pa);
    803      1.1      uch 
    804      1.1      uch 		return (0);
    805      1.1      uch 	}
    806      1.1      uch 
    807      1.1      uch  	/* map to physical addreess with specified memory type. */
    808      1.1      uch 	for (i = 0; i < 3; i++, pa += 0x01000000, va += 0x01000000) {
    809      1.1      uch 		if (__sh_hd64465_map(va, pa, 0x2000, mode[i]) != 0) {
    810      1.1      uch 			uvm_km_free(kernel_map, v, 0x03000000);
    811      1.1      uch 			return (0);
    812      1.1      uch 		}
    813      1.1      uch 	}
    814      1.1      uch 
    815      1.1      uch 	return (v);
    816      1.1      uch }
    817      1.1      uch 
    818      1.1      uch int
    819      1.1      uch __sh_hd64465_map(vaddr_t va, paddr_t pa, size_t sz, u_int32_t flags)
    820      1.1      uch {
    821      1.1      uch 	pt_entry_t *pte;
    822      1.1      uch 	paddr_t epa;
    823      1.1      uch 
    824      1.1      uch 	KDASSERT(((pa & PAGE_MASK) == 0) && ((va & PAGE_MASK) == 0) &&
    825      1.1      uch 	    ((sz & PAGE_MASK) == 0));
    826      1.1      uch 
    827      1.1      uch 	epa = pa + sz;
    828      1.1      uch 	while (pa < epa) {
    829      1.1      uch 		if (pmap_enter(pmap_kernel(), va, pa,
    830      1.1      uch 		    VM_PROT_READ | VM_PROT_WRITE, PMAP_WIRED) != 0) {
    831      1.1      uch 			PRINTF("can't map va 0x%08x -> pa 0x%08x\n",
    832      1.1      uch 			    (unsigned)va, (unsigned)pa);
    833      1.1      uch 			return (1);
    834      1.1      uch 		}
    835      1.1      uch 
    836      1.1      uch 		pte = kvtopte(va);
    837      1.1      uch 		*pte &= ~PG_N; /* uncacheable */
    838      1.1      uch 		*pte |= flags;  /* PTEA PCMCIA assistant bit */
    839      1.1      uch 		pmap_update_pg(va);
    840      1.1      uch 
    841      1.1      uch 		pa += NBPG;
    842      1.1      uch 		va += NBPG;
    843      1.1      uch 	}
    844      1.1      uch 
    845      1.1      uch 	pmap_update(pmap_kernel());
    846      1.1      uch 
    847      1.1      uch 	return (0);
    848      1.1      uch }
    849