blob: d1ec3c82b5473e6e5d9104ac196fac3171d605cd [file] [log] [blame]
// SPDX-License-Identifier: GPL-2.0+
/*
* SAMA7G5 PMC clock support.
*
* Copyright (C) 2020 Microchip Technology Inc. and its subsidiaries
*
* Author: Claudiu Beznea <claudiu.beznea@microchip.com>
*
* Based on drivers/clk/at91/sama7g5.c from Linux.
*/
#include <common.h>
#include <clk-uclass.h>
#include <dm.h>
#include <dt-bindings/clk/at91.h>
#include <linux/clk-provider.h>
#include "pmc.h"
/**
* Clock identifiers to be used in conjunction with macros like
* AT91_TO_CLK_ID()
*
* @ID_MD_SLCK: TD slow clock identifier
* @ID_TD_SLCK: MD slow clock identifier
* @ID_MAIN_XTAL: Main Xtal clock identifier
* @ID_MAIN_RC: Main RC clock identifier
* @ID_MAIN_RC_OSC: Main RC Oscillator clock identifier
* @ID_MAIN_OSC: Main Oscillator clock identifier
* @ID_MAINCK: MAINCK clock identifier
* @ID_PLL_CPU_FRAC: CPU PLL fractional clock identifier
* @ID_PLL_CPU_DIV: CPU PLL divider clock identifier
* @ID_PLL_SYS_FRAC: SYS PLL fractional clock identifier
* @ID_PLL_SYS_DIV: SYS PLL divider clock identifier
* @ID_PLL_DDR_FRAC: DDR PLL fractional clock identifier
* @ID_PLL_DDR_DIV: DDR PLL divider clock identifier
* @ID_PLL_IMG_FRAC: IMC PLL fractional clock identifier
* @ID_PLL_IMG_DIV: IMG PLL divider clock identifier
* @ID_PLL_BAUD_FRAC: Baud PLL fractional clock identifier
* @ID_PLL_BAUD_DIV: Baud PLL divider clock identifier
* @ID_PLL_AUDIO_FRAC: Audio PLL fractional clock identifier
* @ID_PLL_AUDIO_DIVPMC: Audio PLL PMC divider clock identifier
* @ID_PLL_AUDIO_DIVIO: Audio PLL IO divider clock identifier
* @ID_PLL_ETH_FRAC: Ethernet PLL fractional clock identifier
* @ID_PLL_ETH_DIV: Ethernet PLL divider clock identifier
* @ID_MCK0_PRES: MCK0 PRES clock identifier
* @ID_MCK0_DIV: MCK0 DIV clock identifier
* @ID_MCK1: MCK1 clock identifier
* @ID_MCK2: MCK2 clock identifier
* @ID_MCK3: MCK3 clock identifier
* @ID_MCK4: MCK4 clock identifier
* @ID_UTMI: UTMI clock identifier
* @ID_PROG0: Programmable 0 clock identifier
* @ID_PROG1: Programmable 1 clock identifier
* @ID_PROG2: Programmable 2 clock identifier
* @ID_PROG3: Programmable 3 clock identifier
* @ID_PROG4: Programmable 4 clock identifier
* @ID_PROG5: Programmable 5 clock identifier
* @ID_PROG6: Programmable 6 clock identifier
* @ID_PROG7: Programmable 7 clock identifier
* @ID_PCK0: System clock 0 clock identifier
* @ID_PCK1: System clock 1 clock identifier
* @ID_PCK2: System clock 2 clock identifier
* @ID_PCK3: System clock 3 clock identifier
* @ID_PCK4: System clock 4 clock identifier
* @ID_PCK5: System clock 5 clock identifier
* @ID_PCK6: System clock 6 clock identifier
* @ID_PCK7: System clock 7 clock identifier
*/
enum pmc_clk_ids {
ID_MD_SLCK = 0,
ID_TD_SLCK = 1,
ID_MAIN_XTAL = 2,
ID_MAIN_RC = 3,
ID_MAIN_RC_OSC = 4,
ID_MAIN_OSC = 5,
ID_MAINCK = 6,
ID_PLL_CPU_FRAC = 7,
ID_PLL_CPU_DIV = 8,
ID_PLL_SYS_FRAC = 9,
ID_PLL_SYS_DIV = 10,
ID_PLL_DDR_FRAC = 11,
ID_PLL_DDR_DIV = 12,
ID_PLL_IMG_FRAC = 13,
ID_PLL_IMG_DIV = 14,
ID_PLL_BAUD_FRAC = 15,
ID_PLL_BAUD_DIV = 16,
ID_PLL_AUDIO_FRAC = 17,
ID_PLL_AUDIO_DIVPMC = 18,
ID_PLL_AUDIO_DIVIO = 19,
ID_PLL_ETH_FRAC = 20,
ID_PLL_ETH_DIV = 21,
ID_MCK0_DIV = 22,
ID_MCK1 = 23,
ID_MCK2 = 24,
ID_MCK3 = 25,
ID_MCK4 = 26,
ID_UTMI = 27,
ID_PROG0 = 28,
ID_PROG1 = 29,
ID_PROG2 = 30,
ID_PROG3 = 31,
ID_PROG4 = 32,
ID_PROG5 = 33,
ID_PROG6 = 34,
ID_PROG7 = 35,
ID_PCK0 = 36,
ID_PCK1 = 37,
ID_PCK2 = 38,
ID_PCK3 = 39,
ID_PCK4 = 40,
ID_PCK5 = 41,
ID_PCK6 = 42,
ID_PCK7 = 43,
ID_MCK0_PRES = 44,
ID_MAX,
};
/**
* PLL type identifiers
* @PLL_TYPE_FRAC: fractional PLL identifier
* @PLL_TYPE_DIV: divider PLL identifier
*/
enum pll_type {
PLL_TYPE_FRAC,
PLL_TYPE_DIV,
};
/* Clock names used as parents for multiple clocks. */
static const char *clk_names[] = {
[ID_MAIN_RC_OSC] = "main_rc_osc",
[ID_MAIN_OSC] = "main_osc",
[ID_MAINCK] = "mainck",
[ID_PLL_CPU_DIV] = "cpupll_divpmcck",
[ID_PLL_SYS_DIV] = "syspll_divpmcck",
[ID_PLL_DDR_DIV] = "ddrpll_divpmcck",
[ID_PLL_IMG_DIV] = "imgpll_divpmcck",
[ID_PLL_BAUD_DIV] = "baudpll_divpmcck",
[ID_PLL_AUDIO_DIVPMC] = "audiopll_divpmcck",
[ID_PLL_AUDIO_DIVIO] = "audiopll_diviock",
[ID_PLL_ETH_DIV] = "ethpll_divpmcck",
[ID_MCK0_DIV] = "mck0_div",
[ID_MCK0_PRES] = "mck0_pres",
};
/* Fractional PLL output range. */
static const struct clk_range pll_outputs[] = {
{ .min = 2343750, .max = 1200000000 },
};
/* PLL characteristics. */
static const struct clk_pll_characteristics pll_characteristics = {
.input = { .min = 12000000, .max = 50000000 },
.num_output = ARRAY_SIZE(pll_outputs),
.output = pll_outputs,
};
/* Layout for fractional PLLs. */
static const struct clk_pll_layout pll_layout_frac = {
.mul_mask = GENMASK(31, 24),
.frac_mask = GENMASK(21, 0),
.mul_shift = 24,
.frac_shift = 0,
};
/* Layout for DIVPMC dividers. */
static const struct clk_pll_layout pll_layout_divpmc = {
.div_mask = GENMASK(7, 0),
.endiv_mask = BIT(29),
.div_shift = 0,
.endiv_shift = 29,
};
/* Layout for DIVIO dividers. */
static const struct clk_pll_layout pll_layout_divio = {
.div_mask = GENMASK(19, 12),
.endiv_mask = BIT(30),
.div_shift = 12,
.endiv_shift = 30,
};
/* MCK0 characteristics. */
static const struct clk_master_characteristics mck0_characteristics = {
.output = { .min = 140000000, .max = 200000000 },
.divisors = { 1, 2, 4, 3, 5 },
.have_div3_pres = 1,
};
/* MCK0 layout. */
static const struct clk_master_layout mck0_layout = {
.mask = 0x773,
.pres_shift = 4,
.offset = 0x28,
};
/* Programmable clock layout. */
static const struct clk_programmable_layout programmable_layout = {
.pres_mask = 0xff,
.pres_shift = 8,
.css_mask = 0x1f,
.have_slck_mck = 0,
.is_pres_direct = 1,
};
/* Peripheral clock layout. */
static const struct clk_pcr_layout sama7g5_pcr_layout = {
.offset = 0x88,
.cmd = BIT(31),
.gckcss_mask = GENMASK(12, 8),
.pid_mask = GENMASK(6, 0),
.div_mask = GENMASK(15, 14),
};
/**
* PLL clocks description
* @n: clock name
* @p: clock parent
* @l: clock layout
* @t: clock type
* @c: true if clock is critical and cannot be disabled
* @id: clock id corresponding to PLL driver
* @cid: clock id corresponding to clock subsystem
*/
static const struct {
const char *n;
const char *p;
const struct clk_pll_layout *l;
u8 t;
u8 c;
u8 id;
u8 cid;
} sama7g5_plls[] = {
{
.n = "cpupll_fracck",
.p = "mainck",
.l = &pll_layout_frac,
.t = PLL_TYPE_FRAC,
.c = 1,
.id = 0,
.cid = ID_PLL_CPU_FRAC,
},
{
.n = "cpupll_divpmcck",
.p = "cpupll_fracck",
.l = &pll_layout_divpmc,
.t = PLL_TYPE_DIV,
.c = 1,
.id = 0,
.cid = ID_PLL_CPU_DIV,
},
{
.n = "syspll_fracck",
.p = "mainck",
.l = &pll_layout_frac,
.t = PLL_TYPE_FRAC,
.c = 1,
.id = 1,
.cid = ID_PLL_SYS_FRAC,
},
{
.n = "syspll_divpmcck",
.p = "syspll_fracck",
.l = &pll_layout_divpmc,
.t = PLL_TYPE_DIV,
.c = 1,
.id = 1,
.cid = ID_PLL_SYS_DIV,
},
{
.n = "ddrpll_fracck",
.p = "mainck",
.l = &pll_layout_frac,
.t = PLL_TYPE_FRAC,
.c = 1,
.id = 2,
.cid = ID_PLL_DDR_FRAC,
},
{
.n = "ddrpll_divpmcck",
.p = "ddrpll_fracck",
.l = &pll_layout_divpmc,
.t = PLL_TYPE_DIV,
.c = 1,
.id = 2,
.cid = ID_PLL_DDR_DIV,
},
{
.n = "imgpll_fracck",
.p = "mainck",
.l = &pll_layout_frac,
.t = PLL_TYPE_FRAC,
.id = 3,
.cid = ID_PLL_IMG_FRAC,
},
{
.n = "imgpll_divpmcck",
.p = "imgpll_fracck",
.l = &pll_layout_divpmc,
.t = PLL_TYPE_DIV,
.id = 3,
.cid = ID_PLL_IMG_DIV
},
{
.n = "baudpll_fracck",
.p = "mainck",
.l = &pll_layout_frac,
.t = PLL_TYPE_FRAC,
.id = 4,
.cid = ID_PLL_BAUD_FRAC,
},
{
.n = "baudpll_divpmcck",
.p = "baudpll_fracck",
.l = &pll_layout_divpmc,
.t = PLL_TYPE_DIV,
.id = 4,
.cid = ID_PLL_BAUD_DIV,
},
{
.n = "audiopll_fracck",
.p = "main_osc",
.l = &pll_layout_frac,
.t = PLL_TYPE_FRAC,
.id = 5,
.cid = ID_PLL_AUDIO_FRAC,
},
{
.n = "audiopll_divpmcck",
.p = "audiopll_fracck",
.l = &pll_layout_divpmc,
.t = PLL_TYPE_DIV,
.id = 5,
.cid = ID_PLL_AUDIO_DIVPMC,
},
{
.n = "audiopll_diviock",
.p = "audiopll_fracck",
.l = &pll_layout_divio,
.t = PLL_TYPE_DIV,
.id = 5,
.cid = ID_PLL_AUDIO_DIVIO,
},
{
.n = "ethpll_fracck",
.p = "main_osc",
.l = &pll_layout_frac,
.t = PLL_TYPE_FRAC,
.id = 6,
.cid = ID_PLL_ETH_FRAC,
},
{
.n = "ethpll_divpmcck",
.p = "ethpll_fracck",
.l = &pll_layout_divpmc,
.t = PLL_TYPE_DIV,
.id = 6,
.cid = ID_PLL_ETH_DIV,
},
};
/**
* Master clock (MCK[1..4]) description
* @n: clock name
* @ep: extra parents names array
* @ep_chg_chg_id: index in parents array that specifies the changeable
* parent
* @ep_count: extra parents count
* @ep_mux_table: mux table for extra parents
* @ep_clk_mux_table: mux table to deal with subsystem clock ids
* @id: clock id corresponding to MCK driver
* @cid: clock id corresponding to clock subsystem
* @c: true if clock is critical and cannot be disabled
*/
static const struct {
const char *n;
const char *ep[4];
u8 ep_count;
u8 ep_mux_table[4];
u8 ep_clk_mux_table[4];
u8 id;
u8 cid;
u8 c;
} sama7g5_mckx[] = {
{
.n = "mck1",
.id = 1,
.cid = ID_MCK1,
.ep = { "syspll_divpmcck", },
.ep_mux_table = { 5, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, },
.ep_count = 1,
.c = 1,
},
{
.n = "mck2",
.id = 2,
.cid = ID_MCK2,
.ep = { "ddrpll_divpmcck", },
.ep_mux_table = { 6, },
.ep_clk_mux_table = { ID_PLL_DDR_DIV, },
.ep_count = 1,
.c = 1,
},
{
.n = "mck3",
.id = 3,
.cid = ID_MCK3,
.ep = { "syspll_divpmcck", "ddrpll_divpmcck", "imgpll_divpmcck", },
.ep_mux_table = { 5, 6, 7, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_DDR_DIV, ID_PLL_IMG_DIV, },
.ep_count = 3,
},
{
.n = "mck4",
.id = 4,
.cid = ID_MCK4,
.ep = { "syspll_divpmcck", },
.ep_mux_table = { 5, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, },
.ep_count = 1,
.c = 1,
},
};
/**
* Programmable clock description
* @n: clock name
* @cid: clock id corresponding to clock subsystem
*/
static const struct {
const char *n;
u8 cid;
} sama7g5_prog[] = {
{ .n = "prog0", .cid = ID_PROG0, },
{ .n = "prog1", .cid = ID_PROG1, },
{ .n = "prog2", .cid = ID_PROG2, },
{ .n = "prog3", .cid = ID_PROG3, },
{ .n = "prog4", .cid = ID_PROG4, },
{ .n = "prog5", .cid = ID_PROG5, },
{ .n = "prog6", .cid = ID_PROG6, },
{ .n = "prog7", .cid = ID_PROG7, },
};
/* Mux table for programmable clocks. */
static u32 sama7g5_prog_mux_table[] = { 0, 1, 2, 3, 5, 6, 7, 8, 9, 10, };
/**
* System clock description
* @n: clock name
* @p: parent clock name
* @id: clock id corresponding to system clock driver
* @cid: clock id corresponding to clock subsystem
*/
static const struct {
const char *n;
const char *p;
u8 id;
u8 cid;
} sama7g5_systemck[] = {
{ .n = "pck0", .p = "prog0", .id = 8, .cid = ID_PCK0, },
{ .n = "pck1", .p = "prog1", .id = 9, .cid = ID_PCK1, },
{ .n = "pck2", .p = "prog2", .id = 10, .cid = ID_PCK2, },
{ .n = "pck3", .p = "prog3", .id = 11, .cid = ID_PCK3, },
{ .n = "pck4", .p = "prog4", .id = 12, .cid = ID_PCK4, },
{ .n = "pck5", .p = "prog5", .id = 13, .cid = ID_PCK5, },
{ .n = "pck6", .p = "prog6", .id = 14, .cid = ID_PCK6, },
{ .n = "pck7", .p = "prog7", .id = 15, .cid = ID_PCK7, },
};
/**
* Peripheral clock description
* @n: clock name
* @p: clock parent name
* @r: clock range values
* @id: clock id
*/
static const struct {
const char *n;
const char *p;
struct clk_range r;
u8 id;
} sama7g5_periphck[] = {
{ .n = "pioA_clk", .p = "mck0_div", .id = 11, },
{ .n = "sfr_clk", .p = "mck1", .id = 19, },
{ .n = "hsmc_clk", .p = "mck1", .id = 21, },
{ .n = "xdmac0_clk", .p = "mck1", .id = 22, },
{ .n = "xdmac1_clk", .p = "mck1", .id = 23, },
{ .n = "xdmac2_clk", .p = "mck1", .id = 24, },
{ .n = "acc_clk", .p = "mck1", .id = 25, },
{ .n = "aes_clk", .p = "mck1", .id = 27, },
{ .n = "tzaesbasc_clk", .p = "mck1", .id = 28, },
{ .n = "asrc_clk", .p = "mck1", .id = 30, .r = { .max = 200000000, }, },
{ .n = "cpkcc_clk", .p = "mck0_div", .id = 32, },
{ .n = "csi_clk", .p = "mck3", .id = 33, .r = { .max = 266000000, }, },
{ .n = "csi2dc_clk", .p = "mck3", .id = 34, .r = { .max = 266000000, }, },
{ .n = "eic_clk", .p = "mck1", .id = 37, },
{ .n = "flex0_clk", .p = "mck1", .id = 38, },
{ .n = "flex1_clk", .p = "mck1", .id = 39, },
{ .n = "flex2_clk", .p = "mck1", .id = 40, },
{ .n = "flex3_clk", .p = "mck1", .id = 41, },
{ .n = "flex4_clk", .p = "mck1", .id = 42, },
{ .n = "flex5_clk", .p = "mck1", .id = 43, },
{ .n = "flex6_clk", .p = "mck1", .id = 44, },
{ .n = "flex7_clk", .p = "mck1", .id = 45, },
{ .n = "flex8_clk", .p = "mck1", .id = 46, },
{ .n = "flex9_clk", .p = "mck1", .id = 47, },
{ .n = "flex10_clk", .p = "mck1", .id = 48, },
{ .n = "flex11_clk", .p = "mck1", .id = 49, },
{ .n = "gmac0_clk", .p = "mck1", .id = 51, },
{ .n = "gmac1_clk", .p = "mck1", .id = 52, },
{ .n = "gmac0_tsu_clk", .p = "mck1", .id = 53, },
{ .n = "gmac1_tsu_clk", .p = "mck1", .id = 54, },
{ .n = "icm_clk", .p = "mck1", .id = 55, },
{ .n = "isc_clk", .p = "mck3", .id = 56, .r = { .max = 266000000, }, },
{ .n = "i2smcc0_clk", .p = "mck1", .id = 57, .r = { .max = 200000000, }, },
{ .n = "i2smcc1_clk", .p = "mck1", .id = 58, .r = { .max = 200000000, }, },
{ .n = "matrix_clk", .p = "mck1", .id = 60, },
{ .n = "mcan0_clk", .p = "mck1", .id = 61, .r = { .max = 200000000, }, },
{ .n = "mcan1_clk", .p = "mck1", .id = 62, .r = { .max = 200000000, }, },
{ .n = "mcan2_clk", .p = "mck1", .id = 63, .r = { .max = 200000000, }, },
{ .n = "mcan3_clk", .p = "mck1", .id = 64, .r = { .max = 200000000, }, },
{ .n = "mcan4_clk", .p = "mck1", .id = 65, .r = { .max = 200000000, }, },
{ .n = "mcan5_clk", .p = "mck1", .id = 66, .r = { .max = 200000000, }, },
{ .n = "pdmc0_clk", .p = "mck1", .id = 68, .r = { .max = 200000000, }, },
{ .n = "pdmc1_clk", .p = "mck1", .id = 69, .r = { .max = 200000000, }, },
{ .n = "pit64b0_clk", .p = "mck1", .id = 70, },
{ .n = "pit64b1_clk", .p = "mck1", .id = 71, },
{ .n = "pit64b2_clk", .p = "mck1", .id = 72, },
{ .n = "pit64b3_clk", .p = "mck1", .id = 73, },
{ .n = "pit64b4_clk", .p = "mck1", .id = 74, },
{ .n = "pit64b5_clk", .p = "mck1", .id = 75, },
{ .n = "pwm_clk", .p = "mck1", .id = 77, },
{ .n = "qspi0_clk", .p = "mck1", .id = 78, },
{ .n = "qspi1_clk", .p = "mck1", .id = 79, },
{ .n = "sdmmc0_clk", .p = "mck1", .id = 80, },
{ .n = "sdmmc1_clk", .p = "mck1", .id = 81, },
{ .n = "sdmmc2_clk", .p = "mck1", .id = 82, },
{ .n = "sha_clk", .p = "mck1", .id = 83, },
{ .n = "spdifrx_clk", .p = "mck1", .id = 84, .r = { .max = 200000000, }, },
{ .n = "spdiftx_clk", .p = "mck1", .id = 85, .r = { .max = 200000000, }, },
{ .n = "ssc0_clk", .p = "mck1", .id = 86, .r = { .max = 200000000, }, },
{ .n = "ssc1_clk", .p = "mck1", .id = 87, .r = { .max = 200000000, }, },
{ .n = "tcb0_ch0_clk", .p = "mck1", .id = 88, .r = { .max = 200000000, }, },
{ .n = "tcb0_ch1_clk", .p = "mck1", .id = 89, .r = { .max = 200000000, }, },
{ .n = "tcb0_ch2_clk", .p = "mck1", .id = 90, .r = { .max = 200000000, }, },
{ .n = "tcb1_ch0_clk", .p = "mck1", .id = 91, .r = { .max = 200000000, }, },
{ .n = "tcb1_ch1_clk", .p = "mck1", .id = 92, .r = { .max = 200000000, }, },
{ .n = "tcb1_ch2_clk", .p = "mck1", .id = 93, .r = { .max = 200000000, }, },
{ .n = "tcpca_clk", .p = "mck1", .id = 94, },
{ .n = "tcpcb_clk", .p = "mck1", .id = 95, },
{ .n = "tdes_clk", .p = "mck1", .id = 96, },
{ .n = "trng_clk", .p = "mck1", .id = 97, },
{ .n = "udphsa_clk", .p = "mck1", .id = 104, },
{ .n = "udphsb_clk", .p = "mck1", .id = 105, },
{ .n = "uhphs_clk", .p = "mck1", .id = 106, },
};
/**
* Generic clock description
* @n: clock name
* @ep: extra parents names
* @ep_mux_table: extra parents mux table
* @ep_clk_mux_table: extra parents clock mux table (for CCF)
* @r: clock output range
* @ep_count: extra parents count
* @id: clock id
*/
static const struct {
const char *n;
const char *ep[8];
const char ep_mux_table[8];
const char ep_clk_mux_table[8];
struct clk_range r;
u8 ep_count;
u8 id;
} sama7g5_gck[] = {
{
.n = "adc_gclk",
.id = 26,
.r = { .max = 100000000, },
.ep = { "syspll_divpmcck", "imgpll_divpmcck", "audiopll_divpmcck", },
.ep_mux_table = { 5, 7, 9, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_IMG_DIV,
ID_PLL_AUDIO_DIVPMC, },
.ep_count = 3,
},
{
.n = "asrc_gclk",
.id = 30,
.r = { .max = 200000000 },
.ep = { "audiopll_divpmcck", },
.ep_mux_table = { 9, },
.ep_clk_mux_table = { ID_PLL_AUDIO_DIVPMC, },
.ep_count = 1,
},
{
.n = "csi_gclk",
.id = 33,
.r = { .max = 27000000 },
.ep = { "ddrpll_divpmcck", "imgpll_divpmcck", },
.ep_clk_mux_table = { ID_PLL_DDR_DIV, ID_PLL_IMG_DIV, },
.ep_mux_table = { 6, 7, },
.ep_count = 2,
},
{
.n = "flex0_gclk",
.id = 38,
.r = { .max = 200000000 },
.ep = { "syspll_divpmcck", "baudpll_divpmcck", },
.ep_mux_table = { 5, 8, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_BAUD_DIV, },
.ep_count = 2,
},
{
.n = "flex1_gclk",
.id = 39,
.r = { .max = 200000000 },
.ep = { "syspll_divpmcck", "baudpll_divpmcck", },
.ep_mux_table = { 5, 8, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_BAUD_DIV, },
.ep_count = 2,
},
{
.n = "flex2_gclk",
.id = 40,
.r = { .max = 200000000 },
.ep = { "syspll_divpmcck", "baudpll_divpmcck", },
.ep_mux_table = { 5, 8, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_BAUD_DIV, },
.ep_count = 2,
},
{
.n = "flex3_gclk",
.id = 41,
.r = { .max = 200000000 },
.ep = { "syspll_divpmcck", "baudpll_divpmcck", },
.ep_mux_table = { 5, 8, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_BAUD_DIV, },
.ep_count = 2,
},
{
.n = "flex4_gclk",
.id = 42,
.r = { .max = 200000000 },
.ep = { "syspll_divpmcck", "baudpll_divpmcck", },
.ep_mux_table = { 5, 8, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_BAUD_DIV, },
.ep_count = 2,
},
{
.n = "flex5_gclk",
.id = 43,
.r = { .max = 200000000 },
.ep = { "syspll_divpmcck", "baudpll_divpmcck", },
.ep_mux_table = { 5, 8, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_BAUD_DIV, },
.ep_count = 2,
},
{
.n = "flex6_gclk",
.id = 44,
.r = { .max = 200000000 },
.ep = { "syspll_divpmcck", "baudpll_divpmcck", },
.ep_mux_table = { 5, 8, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_BAUD_DIV, },
.ep_count = 2,
},
{
.n = "flex7_gclk",
.id = 45,
.r = { .max = 200000000 },
.ep = { "syspll_divpmcck", "baudpll_divpmcck", },
.ep_mux_table = { 5, 8, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_BAUD_DIV, },
.ep_count = 2,
},
{
.n = "flex8_gclk",
.id = 46,
.r = { .max = 200000000 },
.ep = { "syspll_divpmcck", "baudpll_divpmcck", },
.ep_mux_table = { 5, 8, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_BAUD_DIV, },
.ep_count = 2,
},
{
.n = "flex9_gclk",
.id = 47,
.r = { .max = 200000000 },
.ep = { "syspll_divpmcck", "baudpll_divpmcck", },
.ep_mux_table = { 5, 8, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_BAUD_DIV, },
.ep_count = 2,
},
{
.n = "flex10_gclk",
.id = 48,
.r = { .max = 200000000 },
.ep = { "syspll_divpmcck", "baudpll_divpmcck", },
.ep_mux_table = { 5, 8, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_BAUD_DIV, },
.ep_count = 2,
},
{
.n = "flex11_gclk",
.id = 49,
.r = { .max = 200000000 },
.ep = { "syspll_divpmcck", "baudpll_divpmcck", },
.ep_mux_table = { 5, 8, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_BAUD_DIV, },
.ep_count = 2,
},
{
.n = "gmac0_gclk",
.id = 51,
.r = { .max = 125000000 },
.ep = { "ethpll_divpmcck", },
.ep_clk_mux_table = { ID_PLL_ETH_DIV, },
.ep_mux_table = { 10, },
.ep_count = 1,
},
{
.n = "gmac1_gclk",
.id = 52,
.r = { .max = 50000000 },
.ep = { "ethpll_divpmcck", },
.ep_mux_table = { 10, },
.ep_clk_mux_table = { ID_PLL_ETH_DIV, },
.ep_count = 1,
},
{
.n = "gmac0_tsu_gclk",
.id = 53,
.r = { .max = 300000000 },
.ep = { "audiopll_divpmcck", "ethpll_divpmcck", },
.ep_mux_table = { 9, 10, },
.ep_clk_mux_table = { ID_PLL_AUDIO_DIVPMC, ID_PLL_ETH_DIV, },
.ep_count = 2,
},
{
.n = "gmac1_tsu_gclk",
.id = 54,
.r = { .max = 300000000 },
.ep = { "audiopll_divpmcck", "ethpll_divpmcck", },
.ep_mux_table = { 9, 10, },
.ep_clk_mux_table = { ID_PLL_AUDIO_DIVPMC, ID_PLL_ETH_DIV, },
.ep_count = 2,
},
{
.n = "i2smcc0_gclk",
.id = 57,
.r = { .max = 100000000 },
.ep = { "syspll_divpmcck", "audiopll_divpmcck", },
.ep_mux_table = { 5, 9, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_AUDIO_DIVPMC, },
.ep_count = 2,
},
{
.n = "i2smcc1_gclk",
.id = 58,
.r = { .max = 100000000 },
.ep = { "syspll_divpmcck", "audiopll_divpmcck", },
.ep_mux_table = { 5, 9, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_AUDIO_DIVPMC, },
.ep_count = 2,
},
{
.n = "mcan0_gclk",
.id = 61,
.r = { .max = 200000000 },
.ep = { "syspll_divpmcck", "baudpll_divpmcck", },
.ep_mux_table = { 5, 8, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_BAUD_DIV, },
.ep_count = 2,
},
{
.n = "mcan1_gclk",
.id = 62,
.r = { .max = 200000000 },
.ep = { "syspll_divpmcck", "baudpll_divpmcck", },
.ep_mux_table = { 5, 8, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_BAUD_DIV, },
.ep_count = 2,
},
{
.n = "mcan2_gclk",
.id = 63,
.r = { .max = 200000000 },
.ep = { "syspll_divpmcck", "baudpll_divpmcck", },
.ep_mux_table = { 5, 8, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_BAUD_DIV, },
.ep_count = 2,
},
{
.n = "mcan3_gclk",
.id = 64,
.r = { .max = 200000000 },
.ep = { "syspll_divpmcck", "baudpll_divpmcck", },
.ep_mux_table = { 5, 8, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_BAUD_DIV, },
.ep_count = 2,
},
{
.n = "mcan4_gclk",
.id = 65,
.r = { .max = 200000000 },
.ep = { "syspll_divpmcck", "baudpll_divpmcck", },
.ep_mux_table = { 5, 8, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_BAUD_DIV, },
.ep_count = 2,
},
{
.n = "mcan5_gclk",
.id = 66,
.r = { .max = 200000000 },
.ep = { "syspll_divpmcck", "baudpll_divpmcck", },
.ep_mux_table = { 5, 8, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_BAUD_DIV, },
.ep_count = 2,
},
{
.n = "pdmc0_gclk",
.id = 68,
.r = { .max = 50000000 },
.ep = { "syspll_divpmcck", "baudpll_divpmcck", },
.ep_mux_table = { 5, 8, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_BAUD_DIV, },
.ep_count = 2,
},
{
.n = "pdmc1_gclk",
.id = 69,
.r = { .max = 50000000, },
.ep = { "syspll_divpmcck", "baudpll_divpmcck", },
.ep_mux_table = { 5, 8, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_BAUD_DIV, },
.ep_count = 2,
},
{
.n = "pit64b0_gclk",
.id = 70,
.r = { .max = 200000000 },
.ep = { "syspll_divpmcck", "imgpll_divpmcck", "baudpll_divpmcck",
"audiopll_divpmcck", "ethpll_divpmcck", },
.ep_mux_table = { 5, 7, 8, 9, 10, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_IMG_DIV,
ID_PLL_BAUD_DIV, ID_PLL_AUDIO_DIVPMC,
ID_PLL_ETH_DIV, },
.ep_count = 5,
},
{
.n = "pit64b1_gclk",
.id = 71,
.r = { .max = 200000000 },
.ep = { "syspll_divpmcck", "imgpll_divpmcck", "baudpll_divpmcck",
"audiopll_divpmcck", "ethpll_divpmcck", },
.ep_mux_table = { 5, 7, 8, 9, 10, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_IMG_DIV,
ID_PLL_BAUD_DIV, ID_PLL_AUDIO_DIVPMC,
ID_PLL_ETH_DIV, },
.ep_count = 5,
},
{
.n = "pit64b2_gclk",
.id = 72,
.r = { .max = 200000000 },
.ep = { "syspll_divpmcck", "imgpll_divpmcck", "baudpll_divpmcck",
"audiopll_divpmcck", "ethpll_divpmcck", },
.ep_mux_table = { 5, 7, 8, 9, 10, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_IMG_DIV,
ID_PLL_BAUD_DIV, ID_PLL_AUDIO_DIVPMC,
ID_PLL_ETH_DIV, },
.ep_count = 5,
},
{
.n = "pit64b3_gclk",
.id = 73,
.r = { .max = 200000000 },
.ep = { "syspll_divpmcck", "imgpll_divpmcck", "baudpll_divpmcck",
"audiopll_divpmcck", "ethpll_divpmcck", },
.ep_mux_table = { 5, 7, 8, 9, 10, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_IMG_DIV,
ID_PLL_BAUD_DIV, ID_PLL_AUDIO_DIVPMC,
ID_PLL_ETH_DIV, },
.ep_count = 5,
},
{
.n = "pit64b4_gclk",
.id = 74,
.r = { .max = 200000000 },
.ep = { "syspll_divpmcck", "imgpll_divpmcck", "baudpll_divpmcck",
"audiopll_divpmcck", "ethpll_divpmcck", },
.ep_mux_table = { 5, 7, 8, 9, 10, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_IMG_DIV,
ID_PLL_BAUD_DIV, ID_PLL_AUDIO_DIVPMC,
ID_PLL_ETH_DIV, },
.ep_count = 5,
},
{
.n = "pit64b5_gclk",
.id = 75,
.r = { .max = 200000000 },
.ep = { "syspll_divpmcck", "imgpll_divpmcck", "baudpll_divpmcck",
"audiopll_divpmcck", "ethpll_divpmcck", },
.ep_mux_table = { 5, 7, 8, 9, 10, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_IMG_DIV,
ID_PLL_BAUD_DIV, ID_PLL_AUDIO_DIVPMC,
ID_PLL_ETH_DIV, },
.ep_count = 5,
},
{
.n = "qspi0_gclk",
.id = 78,
.r = { .max = 200000000 },
.ep = { "syspll_divpmcck", "baudpll_divpmcck", },
.ep_mux_table = { 5, 8, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_IMG_DIV,
ID_PLL_BAUD_DIV, ID_PLL_AUDIO_DIVPMC,
ID_PLL_ETH_DIV, },
.ep_count = 2,
},
{
.n = "qspi1_gclk",
.id = 79,
.r = { .max = 200000000 },
.ep = { "syspll_divpmcck", "baudpll_divpmcck", },
.ep_mux_table = { 5, 8, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_BAUD_DIV, },
.ep_count = 2,
},
{
.n = "sdmmc0_gclk",
.id = 80,
.r = { .max = 208000000 },
.ep = { "syspll_divpmcck", "baudpll_divpmcck", },
.ep_mux_table = { 5, 8, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_BAUD_DIV, },
.ep_count = 2,
},
{
.n = "sdmmc1_gclk",
.id = 81,
.r = { .max = 208000000 },
.ep = { "syspll_divpmcck", "baudpll_divpmcck", },
.ep_mux_table = { 5, 8, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_BAUD_DIV, },
.ep_count = 2,
},
{
.n = "sdmmc2_gclk",
.id = 82,
.r = { .max = 208000000 },
.ep = { "syspll_divpmcck", "baudpll_divpmcck", },
.ep_mux_table = { 5, 8, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_BAUD_DIV, },
.ep_count = 2,
},
{
.n = "spdifrx_gclk",
.id = 84,
.r = { .max = 150000000 },
.ep = { "syspll_divpmcck", "audiopll_divpmcck", },
.ep_mux_table = { 5, 9, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_AUDIO_DIVPMC, },
.ep_count = 2,
},
{
.n = "spdiftx_gclk",
.id = 85,
.r = { .max = 25000000 },
.ep = { "syspll_divpmcck", "audiopll_divpmcck", },
.ep_mux_table = { 5, 9, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_AUDIO_DIVPMC, },
.ep_count = 2,
},
{
.n = "tcb0_ch0_gclk",
.id = 88,
.r = { .max = 200000000 },
.ep = { "syspll_divpmcck", "imgpll_divpmcck", "baudpll_divpmcck",
"audiopll_divpmcck", "ethpll_divpmcck", },
.ep_mux_table = { 5, 7, 8, 9, 10, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_IMG_DIV,
ID_PLL_BAUD_DIV, ID_PLL_AUDIO_DIVPMC,
ID_PLL_ETH_DIV, },
.ep_count = 5,
},
{
.n = "tcb1_ch0_gclk",
.id = 91,
.r = { .max = 200000000 },
.ep = { "syspll_divpmcck", "imgpll_divpmcck", "baudpll_divpmcck",
"audiopll_divpmcck", "ethpll_divpmcck", },
.ep_mux_table = { 5, 7, 8, 9, 10, },
.ep_clk_mux_table = { ID_PLL_SYS_DIV, ID_PLL_IMG_DIV,
ID_PLL_BAUD_DIV, ID_PLL_AUDIO_DIVPMC,
ID_PLL_ETH_DIV, },
.ep_count = 5,
},
};
/**
* Clock setup description
* @cid: clock id corresponding to clock subsystem
* @pid: parent clock id corresponding to clock subsystem
* @rate: clock rate
* @prate: parent rate
*/
static const struct pmc_clk_setup {
unsigned int cid;
unsigned int pid;
unsigned long rate;
unsigned long prate;
} sama7g5_clk_setup[] = {
{
.cid = AT91_TO_CLK_ID(PMC_TYPE_CORE, ID_PLL_ETH_FRAC),
.rate = 625000000,
},
{
.cid = AT91_TO_CLK_ID(PMC_TYPE_CORE, ID_PLL_ETH_DIV),
.rate = 625000000,
},
};
#define SAMA7G5_MAX_MUX_ALLOCS (64)
#define prepare_mux_table(_allocs, _index, _dst, _src, _num, _label) \
do { \
int _i; \
if ((_index) >= SAMA7G5_MAX_MUX_ALLOCS) { \
debug("%s(): AT91: MUX: insufficient space\n", \
__func__); \
goto _label; \
} \
(_dst) = kzalloc(sizeof(*(_dst)) * (_num), GFP_KERNEL); \
if (!(_dst)) \
goto _label; \
(_allocs)[(_index)++] = (_dst); \
for (_i = 0; _i < (_num); _i++) \
(_dst)[_i] = (_src)[_i]; \
} while (0)
static int sama7g5_clk_probe(struct udevice *dev)
{
void __iomem *base = (void *)devfdt_get_addr(dev);
unsigned int *clkmuxallocs[SAMA7G5_MAX_MUX_ALLOCS];
unsigned int *muxallocs[SAMA7G5_MAX_MUX_ALLOCS];
const char *p[10];
unsigned int cm[10], m[10], *tmpclkmux, *tmpmux;
struct clk clk, *c, *parent;
bool main_osc_bypass;
int ret, muxallocindex = 0, clkmuxallocindex = 0, i, j;
if (IS_ERR(base))
return PTR_ERR(base);
memset(muxallocs, 0, ARRAY_SIZE(muxallocs));
memset(clkmuxallocs, 0, ARRAY_SIZE(clkmuxallocs));
ret = clk_get_by_index(dev, 0, &clk);
if (ret)
return ret;
ret = clk_get_by_id(clk.id, &c);
if (ret)
return ret;
clk_names[ID_TD_SLCK] = kmemdup(clk_hw_get_name(c),
strlen(clk_hw_get_name(c)) + 1, GFP_KERNEL);
if (!clk_names[ID_TD_SLCK])
return -ENOMEM;
ret = clk_get_by_index(dev, 1, &clk);
if (ret)
return ret;
ret = clk_get_by_id(clk.id, &c);
if (ret)
return ret;
clk_names[ID_MD_SLCK] = kmemdup(clk_hw_get_name(c),
strlen(clk_hw_get_name(c)) + 1, GFP_KERNEL);
if (!clk_names[ID_MD_SLCK])
return -ENOMEM;
ret = clk_get_by_index(dev, 2, &clk);
if (ret)
return ret;
clk_names[ID_MAIN_XTAL] = kmemdup(clk_hw_get_name(&clk),
strlen(clk_hw_get_name(&clk)) + 1, GFP_KERNEL);
if (!clk_names[ID_MAIN_XTAL])
return -ENOMEM;
ret = clk_get_by_index(dev, 3, &clk);
if (ret)
goto fail;
clk_names[ID_MAIN_RC] = kmemdup(clk_hw_get_name(&clk),
strlen(clk_hw_get_name(&clk)) + 1, GFP_KERNEL);
if (ret)
goto fail;
main_osc_bypass = dev_read_bool(dev, "atmel,main-osc-bypass");
/* Register main rc oscillator. */
clk_dm(AT91_TO_CLK_ID(PMC_TYPE_CORE, ID_MAIN_RC_OSC),
at91_clk_main_rc(base, clk_names[ID_MAIN_RC_OSC],
clk_names[ID_MAIN_RC]));
/* Register main oscillator. */
clk_dm(AT91_TO_CLK_ID(PMC_TYPE_CORE, ID_MAIN_OSC),
at91_clk_main_osc(base, clk_names[ID_MAIN_OSC],
clk_names[ID_MAIN_XTAL], main_osc_bypass));
/* Register mainck. */
p[0] = clk_names[ID_MAIN_RC_OSC];
p[1] = clk_names[ID_MAIN_OSC];
cm[0] = AT91_TO_CLK_ID(PMC_TYPE_CORE, ID_MAIN_RC_OSC);
cm[1] = AT91_TO_CLK_ID(PMC_TYPE_CORE, ID_MAIN_OSC);
prepare_mux_table(clkmuxallocs, clkmuxallocindex, tmpclkmux, cm, 2,
fail);
clk_dm(AT91_TO_CLK_ID(PMC_TYPE_CORE, ID_MAINCK),
at91_clk_sam9x5_main(base, clk_names[ID_MAINCK], p,
2, tmpclkmux, PMC_TYPE_CORE));
/* Register PLL fracs clocks. */
for (i = 0; i < ARRAY_SIZE(sama7g5_plls); i++) {
if (sama7g5_plls[i].t != PLL_TYPE_FRAC)
continue;
clk_dm(AT91_TO_CLK_ID(PMC_TYPE_CORE, sama7g5_plls[i].cid),
sam9x60_clk_register_frac_pll(base, sama7g5_plls[i].n,
sama7g5_plls[i].p, sama7g5_plls[i].id,
&pll_characteristics, sama7g5_plls[i].l,
sama7g5_plls[i].c));
}
/* Register PLL div clocks. */
for (i = 0; i < ARRAY_SIZE(sama7g5_plls); i++) {
if (sama7g5_plls[i].t != PLL_TYPE_DIV)
continue;
clk_dm(AT91_TO_CLK_ID(PMC_TYPE_CORE, sama7g5_plls[i].cid),
sam9x60_clk_register_div_pll(base, sama7g5_plls[i].n,
sama7g5_plls[i].p, sama7g5_plls[i].id,
&pll_characteristics, sama7g5_plls[i].l,
sama7g5_plls[i].c));
}
/* Register MCK0_PRES clock. */
p[0] = clk_names[ID_MD_SLCK];
p[1] = clk_names[ID_MAINCK];
p[2] = clk_names[ID_PLL_CPU_DIV];
p[3] = clk_names[ID_PLL_SYS_DIV];
cm[0] = AT91_TO_CLK_ID(PMC_TYPE_CORE, ID_MD_SLCK);
cm[1] = AT91_TO_CLK_ID(PMC_TYPE_CORE, ID_MAINCK);
cm[2] = AT91_TO_CLK_ID(PMC_TYPE_CORE, ID_PLL_CPU_DIV);
cm[3] = AT91_TO_CLK_ID(PMC_TYPE_CORE, ID_PLL_SYS_DIV);
prepare_mux_table(clkmuxallocs, clkmuxallocindex, tmpclkmux, cm, 2,
fail);
clk_dm(AT91_TO_CLK_ID(PMC_TYPE_CORE, ID_MCK0_PRES),
at91_clk_register_master_pres(base, clk_names[ID_MCK0_PRES], p,
4, &mck0_layout, &mck0_characteristics, tmpclkmux));
clk_dm(AT91_TO_CLK_ID(PMC_TYPE_CORE, ID_MCK0_DIV),
at91_clk_register_master_div(base, clk_names[ID_MCK0_DIV],
clk_names[ID_MCK0_PRES], &mck0_layout, &mck0_characteristics));
/* Register MCK1-4 clocks. */
p[0] = clk_names[ID_MD_SLCK];
p[1] = clk_names[ID_TD_SLCK];
p[2] = clk_names[ID_MAINCK];
p[3] = clk_names[ID_MCK0_DIV];
m[0] = 0;
m[1] = 1;
m[2] = 2;
m[3] = 3;
cm[0] = AT91_TO_CLK_ID(PMC_TYPE_CORE, ID_MD_SLCK);
cm[1] = AT91_TO_CLK_ID(PMC_TYPE_CORE, ID_TD_SLCK);
cm[2] = AT91_TO_CLK_ID(PMC_TYPE_CORE, ID_MAINCK);
cm[3] = AT91_TO_CLK_ID(PMC_TYPE_CORE, ID_MCK0_DIV);
for (i = 0; i < ARRAY_SIZE(sama7g5_mckx); i++) {
for (j = 0; j < sama7g5_mckx[i].ep_count; j++) {
p[4 + j] = sama7g5_mckx[i].ep[j];
m[4 + j] = sama7g5_mckx[i].ep_mux_table[j];
cm[4 + j] = AT91_TO_CLK_ID(PMC_TYPE_CORE,
sama7g5_mckx[i].ep_clk_mux_table[j]);
}
prepare_mux_table(clkmuxallocs, clkmuxallocindex, tmpclkmux, cm,
4 + sama7g5_mckx[i].ep_count, fail);
prepare_mux_table(muxallocs, muxallocindex, tmpmux, m,
4 + sama7g5_mckx[i].ep_count, fail);
clk_dm(AT91_TO_CLK_ID(PMC_TYPE_CORE, sama7g5_mckx[i].cid),
at91_clk_sama7g5_register_master(base,
sama7g5_mckx[i].n, p, 4 + sama7g5_mckx[i].ep_count,
tmpmux, tmpclkmux, sama7g5_mckx[i].c,
sama7g5_mckx[i].id));
}
/* Register UTMI clock. */
clk_dm(AT91_TO_CLK_ID(PMC_TYPE_CORE, ID_UTMI),
at91_clk_sama7g5_register_utmi(base, "utmick",
clk_names[ID_MAIN_XTAL]));
/* Register programmable clocks. */
p[0] = clk_names[ID_MD_SLCK];
p[1] = clk_names[ID_TD_SLCK];
p[2] = clk_names[ID_MAINCK];
p[3] = clk_names[ID_MCK0_DIV];
p[4] = clk_names[ID_PLL_SYS_DIV];
p[5] = clk_names[ID_PLL_DDR_DIV];
p[6] = clk_names[ID_PLL_IMG_DIV];
p[7] = clk_names[ID_PLL_BAUD_DIV];
p[8] = clk_names[ID_PLL_AUDIO_DIVPMC];
p[9] = clk_names[ID_PLL_ETH_DIV];
cm[0] = AT91_TO_CLK_ID(PMC_TYPE_CORE, ID_MD_SLCK);
cm[1] = AT91_TO_CLK_ID(PMC_TYPE_CORE, ID_TD_SLCK);
cm[2] = AT91_TO_CLK_ID(PMC_TYPE_CORE, ID_MAINCK);
cm[3] = AT91_TO_CLK_ID(PMC_TYPE_CORE, ID_MCK0_DIV);
cm[4] = AT91_TO_CLK_ID(PMC_TYPE_CORE, ID_PLL_SYS_DIV);
cm[5] = AT91_TO_CLK_ID(PMC_TYPE_CORE, ID_PLL_DDR_DIV);
cm[6] = AT91_TO_CLK_ID(PMC_TYPE_CORE, ID_PLL_IMG_DIV);
cm[7] = AT91_TO_CLK_ID(PMC_TYPE_CORE, ID_PLL_BAUD_DIV);
cm[8] = AT91_TO_CLK_ID(PMC_TYPE_CORE, ID_PLL_AUDIO_DIVPMC);
cm[9] = AT91_TO_CLK_ID(PMC_TYPE_CORE, ID_PLL_ETH_DIV);
for (i = 0; i < ARRAY_SIZE(sama7g5_prog); i++) {
prepare_mux_table(clkmuxallocs, clkmuxallocindex, tmpclkmux, cm,
10, fail);
clk_dm(AT91_TO_CLK_ID(PMC_TYPE_CORE, sama7g5_prog[i].cid),
at91_clk_register_programmable(base, sama7g5_prog[i].n,
p, 10, i, &programmable_layout, tmpclkmux,
sama7g5_prog_mux_table));
}
/* System clocks. */
for (i = 0; i < ARRAY_SIZE(sama7g5_systemck); i++) {
clk_dm(AT91_TO_CLK_ID(PMC_TYPE_SYSTEM, sama7g5_systemck[i].cid),
at91_clk_register_system(base, sama7g5_systemck[i].n,
sama7g5_systemck[i].p, sama7g5_systemck[i].id));
}
/* Peripheral clocks. */
for (i = 0; i < ARRAY_SIZE(sama7g5_periphck); i++) {
clk_dm(AT91_TO_CLK_ID(PMC_TYPE_PERIPHERAL,
sama7g5_periphck[i].id),
at91_clk_register_sam9x5_peripheral(base,
&sama7g5_pcr_layout, sama7g5_periphck[i].n,
sama7g5_periphck[i].p, sama7g5_periphck[i].id,
&sama7g5_periphck[i].r));
}
/* Generic clocks. */
p[0] = clk_names[ID_MD_SLCK];
p[1] = clk_names[ID_TD_SLCK];
p[2] = clk_names[ID_MAINCK];
p[3] = clk_names[ID_MCK0_DIV];
m[0] = 0;
m[1] = 1;
m[2] = 2;
m[3] = 3;
cm[0] = AT91_TO_CLK_ID(PMC_TYPE_CORE, ID_MD_SLCK);
cm[1] = AT91_TO_CLK_ID(PMC_TYPE_CORE, ID_TD_SLCK);
cm[2] = AT91_TO_CLK_ID(PMC_TYPE_CORE, ID_MAINCK);
cm[3] = AT91_TO_CLK_ID(PMC_TYPE_CORE, ID_MCK0_DIV);
for (i = 0; i < ARRAY_SIZE(sama7g5_gck); i++) {
for (j = 0; j < sama7g5_gck[i].ep_count; j++) {
p[4 + j] = sama7g5_gck[i].ep[j];
m[4 + j] = sama7g5_gck[i].ep_mux_table[j];
cm[4 + j] = AT91_TO_CLK_ID(PMC_TYPE_CORE,
sama7g5_gck[i].ep_clk_mux_table[j]);
}
prepare_mux_table(clkmuxallocs, clkmuxallocindex, tmpclkmux, cm,
4 + sama7g5_gck[i].ep_count, fail);
prepare_mux_table(muxallocs, muxallocindex, tmpmux, m,
4 + sama7g5_gck[i].ep_count, fail);
clk_dm(AT91_TO_CLK_ID(PMC_TYPE_GCK, sama7g5_gck[i].id),
at91_clk_register_generic(base, &sama7g5_pcr_layout,
sama7g5_gck[i].n, p, tmpclkmux, tmpmux,
4 + sama7g5_gck[i].ep_count, sama7g5_gck[i].id,
&sama7g5_gck[i].r));
}
/* Setup clocks. */
for (i = 0; i < ARRAY_SIZE(sama7g5_clk_setup); i++) {
ret = clk_get_by_id(sama7g5_clk_setup[i].cid, &c);
if (ret)
goto fail;
if (sama7g5_clk_setup[i].pid) {
ret = clk_get_by_id(sama7g5_clk_setup[i].pid, &parent);
if (ret)
goto fail;
ret = clk_set_parent(c, parent);
if (ret)
goto fail;
if (sama7g5_clk_setup[i].prate) {
ret = clk_set_rate(parent,
sama7g5_clk_setup[i].prate);
if (ret < 0)
goto fail;
}
}
if (sama7g5_clk_setup[i].rate) {
ret = clk_set_rate(c, sama7g5_clk_setup[i].rate);
if (ret < 0)
goto fail;
}
}
return 0;
fail:
for (i = 0; i < ARRAY_SIZE(muxallocs); i++)
kfree(muxallocs[i]);
for (i = 0; i < ARRAY_SIZE(clkmuxallocs); i++)
kfree(clkmuxallocs[i]);
return -ENOMEM;
}
static const struct udevice_id sama7g5_clk_ids[] = {
{ .compatible = "microchip,sama7g5-pmc" },
{ /* Sentinel. */ },
};
U_BOOT_DRIVER(at91_sama7g5_pmc) = {
.name = "at91-sama7g5-pmc",
.id = UCLASS_CLK,
.of_match = sama7g5_clk_ids,
.ops = &at91_clk_ops,
.probe = sama7g5_clk_probe,
.flags = DM_FLAG_PRE_RELOC,
};