d/freebsd-nq
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Add fman and dpaa fixups for powerpc fdt

Browse Source 
Obtained from:	Semihalf
This commit is contained in:
Justin Hibbits 2016-04-15 01:45:05 +00:00
parent 1e6a0e5d79
commit 69f2305587
1 changed files with 62 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

65
sys/dev/fdt/fdt_powerpc.c
View File

@ -46,7 +46,7 @@ __FBSDID("$FreeBSD$");
#include "fdt_common.h"
static void
fdt_fixup_busfreq(phandle_t root)
fdt_fixup_busfreq(phandle_t root, uint32_t div)
{
phandle_t sb, cpus, child;
pcell_t freq;
@ -72,12 +72,71 @@ fdt_fixup_busfreq(phandle_t root)
sizeof(freq)) <= 0)
return;
if (div == 0)
return;
freq /= div;
OF_setprop(sb, "bus-frequency", (void *)&freq, sizeof(freq));
}
static void
fdt_fixup_busfreq_mpc85xx(phandle_t root)
{
fdt_fixup_busfreq(root, 1);
}
static void
fdt_fixup_busfreq_dpaa(phandle_t root)
{
fdt_fixup_busfreq(root, 2);
}
static void
fdt_fixup_fman(phandle_t root)
{
phandle_t node;
pcell_t freq;
if ((node = fdt_find_compatible(root, "simple-bus", 1)) == 0)
return;
if (OF_getprop(node, "bus-frequency", (void *)&freq,
sizeof(freq)) <= 0)
return;
/*
* Set clock-frequency for FMan nodes (only on QorIQ DPAA targets).
* That frequency is equal to /soc node bus-frequency.
*/
for (node = OF_child(node); node != 0; node = OF_peer(node)) {
if (fdt_is_compatible(node, "fsl,fman") == 0)
continue;
if (OF_setprop(node, "clock-frequency", (void *)&freq,
sizeof(freq)) == -1) {
/*
* XXX Shall we take some actions if no clock-frequency
* property was found?
*/
}
}
}
struct fdt_fixup_entry fdt_fixup_table[] = {
{ "fsl,MPC8572DS", &fdt_fixup_busfreq },
{ "MPC8555CDS", &fdt_fixup_busfreq },
{ "fsl,MPC8572DS", &fdt_fixup_busfreq_mpc85xx },
{ "MPC8555CDS", &fdt_fixup_busfreq_mpc85xx },
{ "fsl,P2020", &fdt_fixup_busfreq_mpc85xx },
{ "fsl,P2041RDB", &fdt_fixup_busfreq_dpaa },
{ "fsl,P2041RDB", &fdt_fixup_fman },
{ "fsl,P3041DS", &fdt_fixup_busfreq_dpaa },
{ "fsl,P3041DS", &fdt_fixup_fman },
{ "fsl,P5020DS", &fdt_fixup_busfreq_dpaa },
{ "fsl,P5020DS", &fdt_fixup_fman },
{ "varisys,CYRUS", &fdt_fixup_busfreq_dpaa },
{ "varisys,CYRUS", &fdt_fixup_fman },
{ NULL, NULL }
};