3 * Utility functions for the Freescale MPC52xx.
5 * Copyright (C) 2006 Sylvain Munaut <tnt@246tNt.com>
7 * This file is licensed under the terms of the GNU General Public License
8 * version 2. This program is licensed "as is" without any warranty of any
9 * kind, whether express or implied.
15 #include <linux/kernel.h>
19 #include <asm/of_platform.h>
20 #include <asm/mpc52xx.h>
24 mpc52xx_find_and_map(const char *compatible
)
26 struct device_node
*ofn
;
28 u64 regaddr64
, size64
;
30 ofn
= of_find_compatible_node(NULL
, NULL
, compatible
);
34 regaddr_p
= of_get_address(ofn
, 0, &size64
, NULL
);
40 regaddr64
= of_translate_address(ofn
, regaddr_p
);
44 return ioremap((u32
)regaddr64
, (u32
)size64
);
49 * mpc52xx_find_ipb_freq - Find the IPB bus frequency for a device
52 * Returns IPB bus frequency, or 0 if the bus frequency cannot be found.
55 mpc52xx_find_ipb_freq(struct device_node
*node
)
57 struct device_node
*np
;
58 const unsigned int *p_ipb_freq
= NULL
;
62 p_ipb_freq
= get_property(node
, "bus-frequency", NULL
);
66 np
= of_get_parent(node
);
73 return p_ipb_freq
? *p_ipb_freq
: 0;
78 mpc52xx_setup_cpu(void)
80 struct mpc52xx_cdm __iomem
*cdm
;
81 struct mpc52xx_xlb __iomem
*xlb
;
84 cdm
= mpc52xx_find_and_map("mpc52xx-cdm");
85 xlb
= mpc52xx_find_and_map("mpc52xx-xlb");
88 printk(KERN_ERR __FILE__
": "
89 "Error while mapping CDM/XLB during mpc52xx_setup_cpu. "
90 "Expect some abnormal behavior\n");
94 /* Use internal 48 Mhz */
95 out_8(&cdm
->ext_48mhz_en
, 0x00);
96 out_8(&cdm
->fd_enable
, 0x01);
97 if (in_be32(&cdm
->rstcfg
) & 0x40) /* Assumes 33Mhz clock */
98 out_be16(&cdm
->fd_counters
, 0x0001);
100 out_be16(&cdm
->fd_counters
, 0x5555);
102 /* Configure the XLB Arbiter priorities */
103 out_be32(&xlb
->master_pri_enable
, 0xff);
104 out_be32(&xlb
->master_priority
, 0x11111111);
106 /* Disable XLB pipelining */
107 /* (cfr errate 292. We could do this only just before ATA PIO
108 transaction and re-enable it afterwards ...) */
109 out_be32(&xlb
->config
, in_be32(&xlb
->config
) | MPC52xx_XLB_CFG_PLDIS
);
113 if (cdm
) iounmap(cdm
);
114 if (xlb
) iounmap(xlb
);
118 mpc52xx_declare_of_platform_devices(void)
120 /* Find every child of the SOC node and add it to of_platform */
121 return of_platform_bus_probe(NULL
, NULL
, NULL
);
124 device_initcall(mpc52xx_declare_of_platform_devices
);