1fb180322SJohn Rigby /* 2fb180322SJohn Rigby * Copyright (C) 2007,2008 Freescale Semiconductor, Inc. All rights reserved. 3fb180322SJohn Rigby * 4fb180322SJohn Rigby * Author: John Rigby <jrigby@freescale.com> 5fb180322SJohn Rigby * 6fb180322SJohn Rigby * Description: 7fb180322SJohn Rigby * MPC512x Shared code 8fb180322SJohn Rigby * 9fb180322SJohn Rigby * This is free software; you can redistribute it and/or modify it 10fb180322SJohn Rigby * under the terms of the GNU General Public License as published by 11fb180322SJohn Rigby * the Free Software Foundation; either version 2 of the License, or 12fb180322SJohn Rigby * (at your option) any later version. 13fb180322SJohn Rigby */ 14fb180322SJohn Rigby 15fb180322SJohn Rigby #include <linux/kernel.h> 16fb180322SJohn Rigby #include <linux/io.h> 17fb180322SJohn Rigby #include <linux/irq.h> 18fb180322SJohn Rigby #include <linux/of_platform.h> 19fb180322SJohn Rigby 20fb180322SJohn Rigby #include <asm/machdep.h> 21fb180322SJohn Rigby #include <asm/ipic.h> 22fb180322SJohn Rigby #include <asm/prom.h> 23fb180322SJohn Rigby #include <asm/time.h> 24a8dbceb7SAnatolij Gustschin #include <asm/mpc5121.h> 25fb180322SJohn Rigby 26fb180322SJohn Rigby #include "mpc512x.h" 27fb180322SJohn Rigby 28a8dbceb7SAnatolij Gustschin static struct mpc512x_reset_module __iomem *reset_module_base; 29a8dbceb7SAnatolij Gustschin 30a8dbceb7SAnatolij Gustschin static void __init mpc512x_restart_init(void) 31a8dbceb7SAnatolij Gustschin { 32a8dbceb7SAnatolij Gustschin struct device_node *np; 33a8dbceb7SAnatolij Gustschin 34a8dbceb7SAnatolij Gustschin np = of_find_compatible_node(NULL, NULL, "fsl,mpc5121-reset"); 35a8dbceb7SAnatolij Gustschin if (!np) 36a8dbceb7SAnatolij Gustschin return; 37a8dbceb7SAnatolij Gustschin 38a8dbceb7SAnatolij Gustschin reset_module_base = of_iomap(np, 0); 39a8dbceb7SAnatolij Gustschin of_node_put(np); 40a8dbceb7SAnatolij Gustschin } 41a8dbceb7SAnatolij Gustschin 42a8dbceb7SAnatolij Gustschin void mpc512x_restart(char *cmd) 43a8dbceb7SAnatolij Gustschin { 44a8dbceb7SAnatolij Gustschin if (reset_module_base) { 45a8dbceb7SAnatolij Gustschin /* Enable software reset "RSTE" */ 46a8dbceb7SAnatolij Gustschin out_be32(&reset_module_base->rpr, 0x52535445); 47a8dbceb7SAnatolij Gustschin /* Set software hard reset */ 48a8dbceb7SAnatolij Gustschin out_be32(&reset_module_base->rcr, 0x2); 49a8dbceb7SAnatolij Gustschin } else { 50a8dbceb7SAnatolij Gustschin pr_err("Restart module not mapped.\n"); 51a8dbceb7SAnatolij Gustschin } 52a8dbceb7SAnatolij Gustschin for (;;) 53a8dbceb7SAnatolij Gustschin ; 54a8dbceb7SAnatolij Gustschin } 55a8dbceb7SAnatolij Gustschin 56fb180322SJohn Rigby void __init mpc512x_init_IRQ(void) 57fb180322SJohn Rigby { 58fb180322SJohn Rigby struct device_node *np; 59fb180322SJohn Rigby 60fb180322SJohn Rigby np = of_find_compatible_node(NULL, NULL, "fsl,mpc5121-ipic"); 61fb180322SJohn Rigby if (!np) 62fb180322SJohn Rigby return; 63fb180322SJohn Rigby 64fb180322SJohn Rigby ipic_init(np, 0); 65fb180322SJohn Rigby of_node_put(np); 66fb180322SJohn Rigby 67fb180322SJohn Rigby /* 68fb180322SJohn Rigby * Initialize the default interrupt mapping priorities, 69fb180322SJohn Rigby * in case the boot rom changed something on us. 70fb180322SJohn Rigby */ 71fb180322SJohn Rigby ipic_set_default_priority(); 72fb180322SJohn Rigby } 73fb180322SJohn Rigby 74fb180322SJohn Rigby /* 75fb180322SJohn Rigby * Nodes to do bus probe on, soc and localbus 76fb180322SJohn Rigby */ 77fb180322SJohn Rigby static struct of_device_id __initdata of_bus_ids[] = { 78fb180322SJohn Rigby { .compatible = "fsl,mpc5121-immr", }, 79fb180322SJohn Rigby { .compatible = "fsl,mpc5121-localbus", }, 80fb180322SJohn Rigby {}, 81fb180322SJohn Rigby }; 82fb180322SJohn Rigby 83fb180322SJohn Rigby void __init mpc512x_declare_of_platform_devices(void) 84fb180322SJohn Rigby { 855b2b6255SAnatolij Gustschin struct device_node *np; 865b2b6255SAnatolij Gustschin 87fb180322SJohn Rigby if (of_platform_bus_probe(NULL, of_bus_ids, NULL)) 88fb180322SJohn Rigby printk(KERN_ERR __FILE__ ": " 89fb180322SJohn Rigby "Error while probing of_platform bus\n"); 905b2b6255SAnatolij Gustschin 915b2b6255SAnatolij Gustschin np = of_find_compatible_node(NULL, NULL, "fsl,mpc5121-nfc"); 925b2b6255SAnatolij Gustschin if (np) { 935b2b6255SAnatolij Gustschin of_platform_device_create(np, NULL, NULL); 945b2b6255SAnatolij Gustschin of_node_put(np); 955b2b6255SAnatolij Gustschin } 96fb180322SJohn Rigby } 97fb180322SJohn Rigby 98284ed66fSAnatolij Gustschin void __init mpc512x_init(void) 99284ed66fSAnatolij Gustschin { 100284ed66fSAnatolij Gustschin mpc512x_declare_of_platform_devices(); 101284ed66fSAnatolij Gustschin mpc5121_clk_init(); 102a8dbceb7SAnatolij Gustschin mpc512x_restart_init(); 103284ed66fSAnatolij Gustschin } 104