1/*
  2 * PowerQUICC II support functions
  3 *
  4 * Author: Scott Wood <scottwood@freescale.com>
  5 *
  6 * Copyright (c) 2007 Freescale Semiconductor, Inc.
  7 *
  8 * This program is free software; you can redistribute it and/or modify it
  9 * under the terms of the GNU General Public License version 2 as published
 10 * by the Free Software Foundation.
 11 */
 12
 13#include "ops.h"
 14#include "types.h"
 15#include "fsl-soc.h"
 16#include "pq2.h"
 17#include "stdio.h"
 18#include "io.h"
 19
 20#define PQ2_SCCR (0x10c80/4) /* System Clock Configuration Register */
 21#define PQ2_SCMR (0x10c88/4) /* System Clock Mode Register */
 22
 23static int pq2_corecnf_map[] = {
 24	3, 2, 2, 2, 4, 4, 5, 9, 6, 11, 8, 10, 3, 12, 7, -1,
 25	6, 5, 13, 2, 14, 4, 15, 9, 0, 11, 8, 10, 16, 12, 7, -1
 26};
 27
 28/* Get various clocks from crystal frequency.
 29 * Returns zero on failure and non-zero on success.
 30 */
 31int pq2_get_clocks(u32 crystal, u32 *sysfreq, u32 *corefreq,
 32                   u32 *timebase, u32 *brgfreq)
 33{
 34	u32 *immr;
 35	u32 sccr, scmr, mainclk, busclk;
 36	int corecnf, busdf, plldf, pllmf, dfbrg;
 37
 38	immr = fsl_get_immr();
 39	if (!immr) {
 40		printf("pq2_get_clocks: Couldn't get IMMR base.\r\n");
 41		return 0;
 42	}
 43
 44	sccr = in_be32(&immr[PQ2_SCCR]);
 45	scmr = in_be32(&immr[PQ2_SCMR]);
 46
 47	dfbrg = sccr & 3;
 48	corecnf = (scmr >> 24) & 0x1f;
 49	busdf = (scmr >> 20) & 0xf;
 50	plldf = (scmr >> 12) & 1;
 51	pllmf = scmr & 0xfff;
 52
 53	mainclk = crystal * (pllmf + 1) / (plldf + 1);
 54	busclk = mainclk / (busdf + 1);
 55
 56	if (sysfreq)
 57		*sysfreq = mainclk / 2;
 58	if (timebase)
 59		*timebase = busclk / 4;
 60	if (brgfreq)
 61		*brgfreq = mainclk / (1 << ((dfbrg + 1) * 2));
 62
 63	if (corefreq) {
 64		int coremult = pq2_corecnf_map[corecnf];
 65
 66		if (coremult < 0)
 67			*corefreq = mainclk / 2;
 68		else if (coremult == 0)
 69			return 0;
 70		else
 71			*corefreq = busclk * coremult / 2;
 72	}
 73
 74	return 1;
 75}
 76
 77/* Set common device tree fields based on the given clock frequencies. */
 78void pq2_set_clocks(u32 sysfreq, u32 corefreq, u32 timebase, u32 brgfreq)
 79{
 80	void *node;
 81
 82	dt_fixup_cpu_clocks(corefreq, timebase, sysfreq);
 83
 84	node = finddevice("/soc/cpm");
 85	if (node)
 86		setprop(node, "clock-frequency", &sysfreq, 4);
 87
 88	node = finddevice("/soc/cpm/brg");
 89	if (node)
 90		setprop(node, "clock-frequency", &brgfreq, 4);
 91}
 92
 93int pq2_fixup_clocks(u32 crystal)
 94{
 95	u32 sysfreq, corefreq, timebase, brgfreq;
 96
 97	if (!pq2_get_clocks(crystal, &sysfreq, &corefreq, &timebase, &brgfreq))
 98		return 0;
 99
100	pq2_set_clocks(sysfreq, corefreq, timebase, brgfreq);
101	return 1;
102}