sys/powerpc/mpc85xx/mpc85xx.c

   1 /*-
   2  * Copyright (C) 2008 Semihalf, Rafal Jaworowski
   3  * All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   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.
  13  *
  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
  24  * SUCH DAMAGE.
  25  */
  26
  27 #include <sys/cdefs.h>
  28 __FBSDID("$FreeBSD$");
  29
  30 #include <sys/param.h>
  31 #include <sys/systm.h>
  32 #include <sys/lock.h>
  33 #include <sys/mutex.h>
  34 #include <sys/rman.h>
  35
  36 #include <vm/vm.h>
  37 #include <vm/vm_param.h>
  38
  39 #include <machine/cpu.h>
  40 #include <machine/cpufunc.h>
  41 #include <machine/pio.h>
  42 #include <machine/spr.h>
  43
  44 #include <dev/fdt/fdt_common.h>
  45
  46 #include <powerpc/mpc85xx/mpc85xx.h>
  47
  48 /*
  49  * MPC85xx system specific routines
  50  */
  51
  52 uint32_t
  53 ccsr_read4(uintptr_t addr)
  54 {
  55         volatile uint32_t *ptr = (void *)addr;
  56
  57         return (*ptr);
  58 }
  59
  60 void
  61 ccsr_write4(uintptr_t addr, uint32_t val)
  62 {
  63         volatile uint32_t *ptr = (void *)addr;
  64
  65         *ptr = val;
  66         powerpc_iomb();
  67 }
  68
  69 int
  70 law_getmax(void)
  71 {
  72         uint32_t ver;
  73
  74         ver = SVR_VER(mfspr(SPR_SVR));
  75         if (ver == SVR_MPC8555E || ver == SVR_MPC8555)
  76                 return (8);
  77         if (ver == SVR_MPC8548E || ver == SVR_MPC8548 ||
  78             ver == SVR_MPC8533E || ver == SVR_MPC8533)
  79                 return (10);
  80
  81         return (12);
  82 }
  83
  84 #define _LAW_SR(trgt,size)      (0x80000000 | (trgt << 20) | (ffsl(size) - 2))
  85 #define _LAW_BAR(addr)          (addr >> 12)
  86
  87 int
  88 law_enable(int trgt, u_long addr, u_long size)
  89 {
  90         uint32_t bar, sr;
  91         int i, law_max;
  92
  93         if (size == 0)
  94                 return (0);
  95
  96         law_max = law_getmax();
  97         bar = _LAW_BAR(addr);
  98         sr = _LAW_SR(trgt, size);
  99
 100         /* Bail if already programmed. */
 101         for (i = 0; i < law_max; i++)
 102                 if (sr == ccsr_read4(OCP85XX_LAWSR(i)) &&
 103                     bar == ccsr_read4(OCP85XX_LAWBAR(i)))
 104                         return (0);
 105
 106         /* Find an unused access window. */
 107         for (i = 0; i < law_max; i++)
 108                 if ((ccsr_read4(OCP85XX_LAWSR(i)) & 0x80000000) == 0)
 109                         break;
 110
 111         if (i == law_max)
 112                 return (ENOSPC);
 113
 114         ccsr_write4(OCP85XX_LAWBAR(i), bar);
 115         ccsr_write4(OCP85XX_LAWSR(i), sr);
 116         return (0);
 117 }
 118
 119 int
 120 law_disable(int trgt, u_long addr, u_long size)
 121 {
 122         uint32_t bar, sr;
 123         int i, law_max;
 124
 125         law_max = law_getmax();
 126         bar = _LAW_BAR(addr);
 127         sr = _LAW_SR(trgt, size);
 128
 129         /* Find and disable requested LAW. */
 130         for (i = 0; i < law_max; i++)
 131                 if (sr == ccsr_read4(OCP85XX_LAWSR(i)) &&
 132                     bar == ccsr_read4(OCP85XX_LAWBAR(i))) {
 133                         ccsr_write4(OCP85XX_LAWBAR(i), 0);
 134                         ccsr_write4(OCP85XX_LAWSR(i), 0);
 135                         return (0);
 136                 }
 137
 138         return (ENOENT);
 139 }
 140
 141 int
 142 law_pci_target(struct resource *res, int *trgt_mem, int *trgt_io)
 143 {
 144         u_long start;
 145         uint32_t ver;
 146         int trgt, rv;
 147
 148         ver = SVR_VER(mfspr(SPR_SVR));
 149
 150         start = rman_get_start(res) & 0xf000;
 151
 152         rv = 0;
 153         trgt = -1;
 154         switch (start) {
 155         case 0x8000:
 156                 trgt = 0;
 157                 break;
 158         case 0x9000:
 159                 trgt = 1;
 160                 break;
 161         case 0xa000:
 162                 if (ver == SVR_MPC8548E || ver == SVR_MPC8548)
 163                         trgt = 3;
 164                 else
 165                         trgt = 2;
 166                 break;
 167         case 0xb000:
 168                 if (ver == SVR_MPC8548E || ver == SVR_MPC8548)
 169                         rv = EINVAL;
 170                 else
 171                         trgt = 3;
 172                 break;
 173         default:
 174                 rv = ENXIO;
 175         }
 176         if (rv == 0) {
 177                 *trgt_mem = trgt;
 178                 *trgt_io = trgt;
 179         }
 180         return (rv);
 181 }
 182