speed.c

嵌入式ARM的一些源代码

/*
 * (C) Copyright 2000
 * Wolfgang Denk, DENX Software Engineering, [e-mail].
 *
 * See file CREDITS for list of people who contributed to this
 * project.
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License as
 * published by the Free Software Foundation; either version 2 of
 * the License, or (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
 * MA 02111-1307 USA
 */

#include <ppcboot.h>
#include <mpc8260.h>
#include <asm/processor.h>

/* ------------------------------------------------------------------------- */

/* Bus-to-Core Multiplier */
#define _1x	2
#define _1_5x	3
#define _2x	4
#define _2_5x	5
#define _3x	6
#define _3_5x	7
#define _4x	8
#define _4_5x	9
#define _5x	10
#define _5_5x	11
#define _6x	12
#define _6_5x	13
#define _7x	14
#define _7_5x	15
#define _8x	16
#define _byp	-1
#define _off	-2
#define _unk	-3

typedef struct {
    int b2c_mult;
    int vco_div;
    char *freq_60x;
    char *freq_core;
} corecnf_t;

/*
 * this table based on "Errata to MPC8260 PowerQUICC II User's Manual",
 * Rev. 1, 8/2000, page 10.
 */
corecnf_t corecnf_tab[] = {
    { _1_5x, 4, " 33-100", " 33-100" },		/* 0x00 */
    { _1x,   4, " 50-150", " 50-150" },		/* 0x01 */
    { _1x,   8, " 25-75 ", " 25-75 " },		/* 0x02 */
    { _byp, -1, "  ?-?  ", "  ?-?  " },		/* 0x03 */
    { _2x,   2, " 50-150", "100-300" },		/* 0x04 */
    { _2x,   4, " 25-75 ", " 50-150" },		/* 0x05 */
    { _2_5x, 2, " 40-120", "100-240" },		/* 0x06 */
    { _4_5x, 2, " 22-65 ", "100-300" },		/* 0x07 */
    { _3x,   2, " 33-100", "100-300" },		/* 0x08 */
    { _5_5x, 2, " 18-55 ", "100-300" },		/* 0x09 */
    { _4x,   2, " 25-75 ", "100-300" },		/* 0x0A */
    { _5x,   2, " 20-60 ", "100-300" },		/* 0x0B */
    { _1_5x, 8, " 16-50 ", " 16-50 " },		/* 0x0C */
    { _6x,   2, " 16-50 ", "100-300" },		/* 0x0D */
    { _3_5x, 2, " 30-85 ", "100-300" },		/* 0x0E */
    { _off, -1, "  ?-?  ", "  ?-?  " },		/* 0x0F */
    { _3x,   4, " 16-50 ", " 50-150" },		/* 0x10 */
    { _2_5x, 4, " 20-60 ", " 50-120" },		/* 0x11 */
    { _6_5x, 2, " 15-46 ", "100-300" },		/* 0x12 */
    { _byp, -1, "  ?-?  ", "  ?-?  " },		/* 0x13 */
    { _7x,   2, " 14-43 ", "100-300" },		/* 0x14 */
    { _2x,   4, " 25-75 ", " 50-150" },		/* 0x15 */
    { _7_5x, 2, " 13-40 ", "100-300" },		/* 0x16 */
    { _4_5x, 2, " 22-65 ", "100-300" },		/* 0x17 */
    { _unk, -1, "  ?-?  ", "  ?-?  " },		/* 0x18 */
    { _5_5x, 2, " 18-55 ", "100-300" },		/* 0x19 */
    { _4x,   2, " 25-75 ", "100-300" },		/* 0x1A */
    { _5x,   2, " 20-60 ", "100-300" },		/* 0x1B */
    { _8x,   2, " 12-38 ", "100-300" },		/* 0x1C */
    { _6x,   2, " 16-50 ", "100-300" },		/* 0x1D */
    { _3_5x, 2, " 30-85 ", "100-300" },		/* 0x1E */
    { _off, -1, "  ?-?  ", "  ?-?  " }		/* 0x1F */
};

/* ------------------------------------------------------------------------- */

/*
 * 
 */

void
get_8260_clks(void)
{
    volatile immap_t *immap = (immap_t *)CFG_IMMR;
    ulong clkin;
    ulong sccr, dfbrg;
    ulong scmr, corecnf, busdf, cpmdf, plldf, pllmf;
    corecnf_t *cp;
    /* Pointer to initial global data area */
    init_data_t *idata = \
	(init_data_t *)(CFG_INIT_RAM_ADDR + CFG_INIT_DATA_OFFSET);

#if !defined(CONFIG_8260_CLKIN)
#error clock measuring not implemented yet - define CONFIG_8260_CLKIN
#else
    clkin = CONFIG_8260_CLKIN;
#endif

    sccr = immap->im_clkrst.car_sccr;
    dfbrg = (sccr & SCCR_DFBRG_MSK) >> SCCR_DFBRG_SHIFT;

    scmr = immap->im_clkrst.car_scmr;
    corecnf = (scmr & SCMR_CORECNF_MSK) >> SCMR_CORECNF_SHIFT;
    busdf = (scmr & SCMR_BUSDF_MSK) >> SCMR_BUSDF_SHIFT;
    cpmdf = (scmr & SCMR_CPMDF_MSK) >> SCMR_CPMDF_SHIFT;
    plldf = (scmr & SCMR_PLLDF) ? 1 : 0;
    pllmf = (scmr & SCMR_PLLMF_MSK) >> SCMR_PLLMF_SHIFT;

    cp = &corecnf_tab[corecnf];

    idata->vco_out = (clkin * 2 * (pllmf + 1)) / (plldf + 1);

#if 0
    if (idata->vco_out / (busdf + 1) != clkin)
	/* aaarrrggghhh!!! */ hang();
#endif

    idata->cpm_clk = idata->vco_out / 2;
    idata->bus_clk = clkin;
    idata->scc_clk = idata->vco_out / 4;
    idata->brg_clk = idata->vco_out / (1 << (2 * (dfbrg + 1)));
    if (cp->b2c_mult > 0)
	idata->cpu_clk = (clkin * cp->b2c_mult) / 2;
    else
	idata->cpu_clk = clkin;
}

void
prt_8260_clks(void)
{
    volatile immap_t *immap = (immap_t *)CFG_IMMR;
    ulong sccr, dfbrg;
    ulong scmr, corecnf, busdf, cpmdf, plldf, pllmf;
    corecnf_t *cp;
    /* Pointer to initial global data area */
    init_data_t *idata = \
	(init_data_t *)(CFG_INIT_RAM_ADDR + CFG_INIT_DATA_OFFSET);

    sccr = immap->im_clkrst.car_sccr;
    dfbrg = (sccr & SCCR_DFBRG_MSK) >> SCCR_DFBRG_SHIFT;

    scmr = immap->im_clkrst.car_scmr;
    corecnf = (scmr & SCMR_CORECNF_MSK) >> SCMR_CORECNF_SHIFT;
    busdf = (scmr & SCMR_BUSDF_MSK) >> SCMR_BUSDF_SHIFT;
    cpmdf = (scmr & SCMR_CPMDF_MSK) >> SCMR_CPMDF_SHIFT;
    plldf = (scmr & SCMR_PLLDF) ? 1 : 0;
    pllmf = (scmr & SCMR_PLLMF_MSK) >> SCMR_PLLMF_SHIFT;

    cp = &corecnf_tab[corecnf];

    printf("MPC8260 Clock Configuration\n - Bus-to-Core Mult ");

    switch (cp->b2c_mult) {

    case _byp:
	printf("BYPASS");
	break;

    case _off:
	printf("OFF");
	break;

    case _unk:
	printf("UNKNOWN");
	break;

    default:
	printf("%d%sx", cp->b2c_mult / 2, (cp->b2c_mult % 2) ? ".5" : "");
	break;
    }

    printf(", VCO Div %d, 60x Bus Freq %s, Core Freq %s\n",
	cp->vco_div, cp->freq_60x, cp->freq_core);

    printf(" - dfbrg %ld, corecnf 0x%02lx, busdf %ld, cpmdf %ld, "
	"plldf %ld, pllmf %ld\n", dfbrg, corecnf, busdf, cpmdf, plldf, pllmf);

    printf(" - vco_out %10ld, cpm_clk %10ld, bus_clk %10ld\n",
	idata->vco_out, idata->cpm_clk, idata->bus_clk);

    printf(" - scc_clk %10ld, brg_clk %10ld, cpu_clk %10ld\n\n",
	idata->scc_clk, idata->brg_clk, idata->cpu_clk);
}

/* ------------------------------------------------------------------------- */

ulong
get_bus_freq(ulong gclk_freq)
{
    /* Pointer to initial global data area */
    init_data_t *idata = \
	(init_data_t *)(CFG_INIT_RAM_ADDR + CFG_INIT_DATA_OFFSET);

#if defined(CFG_CLKS_IN_HZ)
    return (idata->bus_clk);
#else
    return (idata->bus_clk / 1000 / 1000);
#endif
}

/* ------------------------------------------------------------------------- */