sys/arm/annapurna/alpine/common.c

   1 /*-
   2  * Copyright (c) 2013 Ruslan Bukin <br@bsdpad.com>
   3  * Copyright (c) 2015 Semihalf.
   4  * All rights reserved.
   5  *
   6  * Redistribution and use in source and binary forms, with or without
   7  * modification, are permitted provided that the following conditions
   8  * are met:
   9  * 1. Redistributions of source code must retain the above copyright
  10  *    notice, this list of conditions and the following disclaimer.
  11  * 2. Redistributions in binary form must reproduce the above copyright
  12  *    notice, this list of conditions and the following disclaimer in the
  13  *    documentation and/or other materials provided with the distribution.
  14  *
  15  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  16  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  17  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  18  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
  19  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  20  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  21  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  22  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  23  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  24  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  25  * SUCH DAMAGE.
  26  *
  27  */
  28
  29 #include <sys/cdefs.h>
  30 __FBSDID("$FreeBSD$");
  31
  32 #include <sys/param.h>
  33 #include <sys/systm.h>
  34 #include <sys/bus.h>
  35 #include <sys/kernel.h>
  36
  37 #include <dev/fdt/fdt_common.h>
  38 #include <dev/ofw/openfirm.h>
  39
  40 #include <machine/bus.h>
  41 #include <machine/fdt.h>
  42 #include <machine/intr.h>
  43
  44 #define WDTLOAD         0x000
  45 #define LOAD_MIN        0x00000001
  46 #define LOAD_MAX        0xFFFFFFFF
  47 #define WDTVALUE        0x004
  48 #define WDTCONTROL      0x008
  49 /* control register masks */
  50 #define INT_ENABLE      (1 << 0)
  51 #define RESET_ENABLE    (1 << 1)
  52 #define WDTLOCK         0xC00
  53 #define UNLOCK          0x1ACCE551
  54 #define LOCK            0x00000001
  55
  56 extern bus_addr_t  al_devmap_pa;
  57 struct fdt_fixup_entry fdt_fixup_table[] = {
  58         { NULL, NULL }
  59 };
  60
  61 static int alpine_get_wdt_base(uint32_t *pbase, uint32_t *psize);
  62 static int alpine_pic_decode_fdt(uint32_t iparent, uint32_t *intr,
  63     int *interrupt, int *trig, int *pol);
  64
  65 int alpine_get_devmap_base(bus_addr_t *pa, bus_addr_t *size);
  66
  67 int alpine_get_devmap_base(bus_addr_t *pa, bus_addr_t *size)
  68 {
  69         phandle_t node;
  70
  71         if ((node = OF_finddevice("/")) == 0)
  72                 return (ENXIO);
  73
  74         if ((node = fdt_find_compatible(node, "simple-bus", 1)) == 0)
  75                 return (ENXIO);
  76
  77         return fdt_get_range(node, 0, pa, size);
  78 }
  79
  80 static int
  81 alpine_get_wdt_base(uint32_t *pbase, uint32_t *psize)
  82 {
  83         phandle_t node;
  84         u_long base = 0;
  85         u_long size = 0;
  86
  87         if (pbase == NULL || psize == NULL)
  88                 return (EINVAL);
  89
  90         if ((node = OF_finddevice("/")) == -1)
  91                 return (EFAULT);
  92
  93         if ((node = fdt_find_compatible(node, "simple-bus", 1)) == 0)
  94                 return (EFAULT);
  95
  96         if ((node =
  97             fdt_find_compatible(node, "arm,sp805", 1)) == 0)
  98                 return (EFAULT);
  99
 100         if (fdt_regsize(node, &base, &size))
 101                 return (EFAULT);
 102
 103         *pbase = base;
 104         *psize = size;
 105
 106         return (0);
 107 }
 108
 109 void
 110 cpu_reset(void)
 111 {
 112         uint32_t wdbase, wdsize;
 113         bus_addr_t wdbaddr;
 114         int ret;
 115
 116         ret = alpine_get_wdt_base(&wdbase, &wdsize);
 117         if (ret) {
 118                 printf("Unable to get WDT base, do power down manually...");
 119                 goto infinite;
 120         }
 121
 122         ret = bus_space_map(fdtbus_bs_tag, al_devmap_pa + wdbase,
 123             wdsize, 0, &wdbaddr);
 124         if (ret) {
 125                 printf("Unable to map WDT base, do power down manually...");
 126                 goto infinite;
 127         }
 128
 129         bus_space_write_4(fdtbus_bs_tag, wdbaddr, WDTLOCK, UNLOCK);
 130         bus_space_write_4(fdtbus_bs_tag, wdbaddr, WDTLOAD, LOAD_MIN);
 131         bus_space_write_4(fdtbus_bs_tag, wdbaddr, WDTCONTROL, INT_ENABLE | RESET_ENABLE);
 132
 133 infinite:
 134         while (1) {}
 135 }
 136
 137 static int
 138 alpine_pic_decode_fdt(uint32_t iparent, uint32_t *intr, int *interrupt,
 139     int *trig, int *pol)
 140 {
 141         int rv = 0;
 142
 143         rv = gic_decode_fdt(iparent, intr, interrupt, trig, pol);
 144         if (rv == 0) {
 145                 /* This was recognized as our PIC and decoded. */
 146                 interrupt = FDT_MAP_IRQ(iparent, interrupt);
 147
 148                 /* Configure the interrupt if callback provided */
 149                 if (arm_config_irq)
 150                         (*arm_config_irq)(*interrupt, *trig, *pol);
 151         }
 152         return (rv);
 153 }
 154
 155 fdt_pic_decode_t fdt_pic_table[] = {
 156         &alpine_pic_decode_fdt,
 157         NULL
 158 };