1 /*- 2 * Copyright (c) 2013 Ruslan Bukin <br@bsdpad.com> 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 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 24 * SUCH DAMAGE. 25 */ 26 27 #include "opt_platform.h" 28 29 #include <sys/cdefs.h> 30 __FBSDID("$FreeBSD$"); 31 32 #include <sys/param.h> 33 #include <sys/systm.h> 34 #include <sys/devmap.h> 35 36 #include <vm/vm.h> 37 38 #include <dev/ofw/openfirm.h> 39 40 #include <machine/bus.h> 41 #include <machine/fdt.h> 42 #include <machine/platform.h> 43 #include <machine/platformvar.h> 44 45 #include <arm/freescale/vybrid/vf_src.h> 46 47 #include "platform_if.h" 48 49 static int 50 vf_devmap_init(platform_t plat) 51 { 52 53 devmap_add_entry(0x40000000, 0x100000); 54 55 return (0); 56 } 57 58 static void 59 vf_cpu_reset(platform_t plat) 60 { 61 phandle_t src; 62 uint32_t paddr; 63 bus_addr_t vaddr; 64 65 if (src_swreset() == 0) 66 goto end; 67 68 src = OF_finddevice("src"); 69 if ((src != 0) && (OF_getencprop(src, "reg", &paddr, sizeof(paddr))) > 0) { 70 if (bus_space_map(fdtbus_bs_tag, paddr, 0x10, 0, &vaddr) == 0) { 71 bus_space_write_4(fdtbus_bs_tag, vaddr, 0x00, SW_RST); 72 } 73 } 74 75 end: 76 while (1); 77 } 78 79 static platform_method_t vf_methods[] = { 80 PLATFORMMETHOD(platform_devmap_init, vf_devmap_init), 81 PLATFORMMETHOD(platform_cpu_reset, vf_cpu_reset), 82 83 PLATFORMMETHOD_END, 84 }; 85 86 FDT_PLATFORM_DEF(vf, "vybrid", 0, "freescale,vybrid", 200); 87