hc
2023-02-15 557890c7ca0980ccc625a4e8f0cfa8898649a5c6
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
/*
 * Architecture- / platform-specific boot-time initialization code for
 * IBM PowerPC 4xx based boards. Adapted from original
 * code by Gary Thomas, Cort Dougan <cort@fsmlabs.com>, and Dan Malek
 * <dan@net4x.com>.
 *
 * Copyright(c) 1999-2000 Grant Erickson <grant@lcse.umn.edu>
 *
 * Rewritten and ported to the merged powerpc tree:
 * Copyright 2007 IBM Corporation
 * Josh Boyer <jwboyer@linux.vnet.ibm.com>
 *
 * Adapted to EP405 by Ben. Herrenschmidt <benh@kernel.crashing.org>
 *
 * TODO: Wire up the PCI IRQ mux and the southbridge interrupts
 *
 * 2002 (c) MontaVista, Software, Inc.  This file is licensed under
 * the terms of the GNU General Public License version 2.  This program
 * is licensed "as is" without any warranty of any kind, whether express
 * or implied.
 */
 
#include <linux/init.h>
#include <linux/of_platform.h>
 
#include <asm/machdep.h>
#include <asm/prom.h>
#include <asm/udbg.h>
#include <asm/time.h>
#include <asm/uic.h>
#include <asm/pci-bridge.h>
#include <asm/ppc4xx.h>
 
static struct device_node *bcsr_node;
static void __iomem *bcsr_regs;
 
/* BCSR registers  */
#define BCSR_ID            0
#define BCSR_PCI_CTRL               1
#define BCSR_FLASH_NV_POR_CTRL    2
#define BCSR_FENET_UART_CTRL    3
#define BCSR_PCI_IRQ        4
#define BCSR_XIRQ_SELECT    5
#define BCSR_XIRQ_ROUTING    6
#define BCSR_XIRQ_STATUS    7
#define BCSR_XIRQ_STATUS2    8
#define BCSR_SW_STAT_LED_CTRL    9
#define BCSR_GPIO_IRQ_PAR_CTRL    10
/* there's more, can't be bothered typing them tho */
 
 
static const struct of_device_id ep405_of_bus[] __initconst = {
   { .compatible = "ibm,plb3", },
   { .compatible = "ibm,opb", },
   { .compatible = "ibm,ebc", },
   {},
};
 
static int __init ep405_device_probe(void)
{
   of_platform_bus_probe(NULL, ep405_of_bus, NULL);
 
   return 0;
}
machine_device_initcall(ep405, ep405_device_probe);
 
static void __init ep405_init_bcsr(void)
{
   const u8 *irq_routing;
   int i;
 
   /* Find the bloody thing & map it */
   bcsr_node = of_find_compatible_node(NULL, NULL, "ep405-bcsr");
   if (bcsr_node == NULL) {
       printk(KERN_ERR "EP405 BCSR not found !\n");
       return;
   }
   bcsr_regs = of_iomap(bcsr_node, 0);
   if (bcsr_regs == NULL) {
       printk(KERN_ERR "EP405 BCSR failed to map !\n");
       return;
   }
 
   /* Get the irq-routing property and apply the routing to the CPLD */
   irq_routing = of_get_property(bcsr_node, "irq-routing", NULL);
   if (irq_routing == NULL)
       return;
   for (i = 0; i < 16; i++) {
       u8 irq = irq_routing[i];
       out_8(bcsr_regs + BCSR_XIRQ_SELECT, i);
       out_8(bcsr_regs + BCSR_XIRQ_ROUTING, irq);
   }
   in_8(bcsr_regs + BCSR_XIRQ_SELECT);
   mb();
   out_8(bcsr_regs + BCSR_GPIO_IRQ_PAR_CTRL, 0xfe);
}
 
static void __init ep405_setup_arch(void)
{
   /* Find & init the BCSR CPLD */
   ep405_init_bcsr();
 
   pci_set_flags(PCI_REASSIGN_ALL_RSRC);
}
 
static int __init ep405_probe(void)
{
   if (!of_machine_is_compatible("ep405"))
       return 0;
 
   return 1;
}
 
define_machine(ep405) {
   .name            = "EP405",
   .probe            = ep405_probe,
   .setup_arch        = ep405_setup_arch,
   .progress        = udbg_progress,
   .init_IRQ        = uic_init_tree,
   .get_irq        = uic_get_irq,
   .restart        = ppc4xx_reset_system,
   .calibrate_decr        = generic_calibrate_decr,
};