drivers/clk/st/clkgen-fsyn.c

   1 /*
   2  * Copyright (C) 2014 STMicroelectronics R&D Ltd
   3  *
   4  * This program is free software; you can redistribute it and/or modify
   5  * it under the terms of the GNU General Public License version 2 as
   6  * published by the Free Software Foundation.
   7  *
   8  */
   9
  10 /*
  11  * Authors:
  12  * Stephen Gallimore <[email protected]>,
  13  * Pankaj Dev <[email protected]>.
  14  */
  15
  16 #include <linux/slab.h>
  17 #include <linux/of_address.h>
  18 #include <linux/clk.h>
  19 #include <linux/clk-provider.h>
  20
  21 #include "clkgen.h"
  22
  23 /*
  24  * Maximum input clock to the PLL before we divide it down by 2
  25  * although in reality in actual systems this has never been seen to
  26  * be used.
  27  */
  28 #define QUADFS_NDIV_THRESHOLD 30000000
  29
  30 #define PLL_BW_GOODREF   (0L)
  31 #define PLL_BW_VBADREF   (1L)
  32 #define PLL_BW_BADREF    (2L)
  33 #define PLL_BW_VGOODREF  (3L)
  34
  35 #define QUADFS_MAX_CHAN 4
  36
  37 struct stm_fs {
  38         unsigned long ndiv;
  39         unsigned long mdiv;
  40         unsigned long pe;
  41         unsigned long sdiv;
  42         unsigned long nsdiv;
  43 };
  44
  45 static const struct stm_fs fs216c65_rtbl[] = {
  46         { .mdiv = 0x1f, .pe = 0x0,      .sdiv = 0x7,    .nsdiv = 0 },   /* 312.5 Khz */
  47         { .mdiv = 0x17, .pe = 0x25ed,   .sdiv = 0x1,    .nsdiv = 0 },   /* 27    MHz */
  48         { .mdiv = 0x1a, .pe = 0x7b36,   .sdiv = 0x2,    .nsdiv = 1 },   /* 36.87 MHz */
  49         { .mdiv = 0x13, .pe = 0x0,      .sdiv = 0x2,    .nsdiv = 1 },   /* 48    MHz */
  50         { .mdiv = 0x11, .pe = 0x1c72,   .sdiv = 0x1,    .nsdiv = 1 },   /* 108   MHz */
  51 };
  52
  53 static const struct stm_fs fs432c65_rtbl[] = {
  54         { .mdiv = 0x1f, .pe = 0x0,      .sdiv = 0x7,    .nsdiv = 0 },   /* 625     Khz */
  55         { .mdiv = 0x13, .pe = 0x777c,   .sdiv = 0x4,    .nsdiv = 1 },   /* 25.175  MHz */
  56         { .mdiv = 0x19, .pe = 0x4d35,   .sdiv = 0x2,    .nsdiv = 0 },   /* 25.200  MHz */
  57         { .mdiv = 0x11, .pe = 0x1c72,   .sdiv = 0x4,    .nsdiv = 1 },   /* 27.000  MHz */
  58         { .mdiv = 0x17, .pe = 0x28f5,   .sdiv = 0x2,    .nsdiv = 0 },   /* 27.027  MHz */
  59         { .mdiv = 0x16, .pe = 0x3359,   .sdiv = 0x2,    .nsdiv = 0 },   /* 28.320  MHz */
  60         { .mdiv = 0x1f, .pe = 0x2083,   .sdiv = 0x3,    .nsdiv = 1 },   /* 30.240  MHz */
  61         { .mdiv = 0x1e, .pe = 0x430d,   .sdiv = 0x3,    .nsdiv = 1 },   /* 31.500  MHz */
  62         { .mdiv = 0x17, .pe = 0x0,      .sdiv = 0x3,    .nsdiv = 1 },   /* 40.000  MHz */
  63         { .mdiv = 0x19, .pe = 0x121a,   .sdiv = 0x1,    .nsdiv = 0 },   /* 49.500  MHz */
  64         { .mdiv = 0x13, .pe = 0x6667,   .sdiv = 0x3,    .nsdiv = 1 },   /* 50.000  MHz */
  65         { .mdiv = 0x10, .pe = 0x1ee6,   .sdiv = 0x3,    .nsdiv = 1 },   /* 57.284  MHz */
  66         { .mdiv = 0x1d, .pe = 0x3b14,   .sdiv = 0x2,    .nsdiv = 1 },   /* 65.000  MHz */
  67         { .mdiv = 0x12, .pe = 0x7c65,   .sdiv = 0x1,    .nsdiv = 0 },   /* 71.000  MHz */
  68         { .mdiv = 0x19, .pe = 0xecd,    .sdiv = 0x2,    .nsdiv = 1 },   /* 74.176  MHz */
  69         { .mdiv = 0x19, .pe = 0x121a,   .sdiv = 0x2,    .nsdiv = 1 },   /* 74.250  MHz */
  70         { .mdiv = 0x19, .pe = 0x3334,   .sdiv = 0x2,    .nsdiv = 1 },   /* 75.000  MHz */
  71         { .mdiv = 0x18, .pe = 0x5138,   .sdiv = 0x2,    .nsdiv = 1 },   /* 78.800  MHz */
  72         { .mdiv = 0x1d, .pe = 0x77d,    .sdiv = 0x0,    .nsdiv = 0 },   /* 85.500  MHz */
  73         { .mdiv = 0x1c, .pe = 0x13d5,   .sdiv = 0x0,    .nsdiv = 0 },   /* 88.750  MHz */
  74         { .mdiv = 0x11, .pe = 0x1c72,   .sdiv = 0x2,    .nsdiv = 1 },   /* 108.000 MHz */
  75         { .mdiv = 0x17, .pe = 0x28f5,   .sdiv = 0x0,    .nsdiv = 0 },   /* 108.108 MHz */
  76         { .mdiv = 0x10, .pe = 0x6e26,   .sdiv = 0x2,    .nsdiv = 1 },   /* 118.963 MHz */
  77         { .mdiv = 0x15, .pe = 0x3e63,   .sdiv = 0x0,    .nsdiv = 0 },   /* 119.000 MHz */
  78         { .mdiv = 0x1c, .pe = 0x471d,   .sdiv = 0x1,    .nsdiv = 1 },   /* 135.000 MHz */
  79         { .mdiv = 0x19, .pe = 0xecd,    .sdiv = 0x1,    .nsdiv = 1 },   /* 148.352 MHz */
  80         { .mdiv = 0x19, .pe = 0x121a,   .sdiv = 0x1,    .nsdiv = 1 },   /* 148.500 MHz */
  81         { .mdiv = 0x19, .pe = 0x121a,   .sdiv = 0x0,    .nsdiv = 1 },   /* 297     MHz */
  82 };
  83
  84 static const struct stm_fs fs660c32_rtbl[] = {
  85         { .mdiv = 0x14, .pe = 0x376b,   .sdiv = 0x4,    .nsdiv = 1 },   /* 25.175  MHz */
  86         { .mdiv = 0x14, .pe = 0x30c3,   .sdiv = 0x4,    .nsdiv = 1 },   /* 25.200  MHz */
  87         { .mdiv = 0x10, .pe = 0x71c7,   .sdiv = 0x4,    .nsdiv = 1 },   /* 27.000  MHz */
  88         { .mdiv = 0x00, .pe = 0x47af,   .sdiv = 0x3,    .nsdiv = 0 },   /* 27.027  MHz */
  89         { .mdiv = 0x0e, .pe = 0x4e1a,   .sdiv = 0x4,    .nsdiv = 1 },   /* 28.320  MHz */
  90         { .mdiv = 0x0b, .pe = 0x534d,   .sdiv = 0x4,    .nsdiv = 1 },   /* 30.240  MHz */
  91         { .mdiv = 0x17, .pe = 0x6fbf,   .sdiv = 0x2,    .nsdiv = 0 },   /* 31.500  MHz */
  92         { .mdiv = 0x01, .pe = 0x0,      .sdiv = 0x4,    .nsdiv = 1 },   /* 40.000  MHz */
  93         { .mdiv = 0x15, .pe = 0x2aab,   .sdiv = 0x3,    .nsdiv = 1 },   /* 49.500  MHz */
  94         { .mdiv = 0x14, .pe = 0x6666,   .sdiv = 0x3,    .nsdiv = 1 },   /* 50.000  MHz */
  95         { .mdiv = 0x1d, .pe = 0x395f,   .sdiv = 0x1,    .nsdiv = 0 },   /* 57.284  MHz */
  96         { .mdiv = 0x08, .pe = 0x4ec5,   .sdiv = 0x3,    .nsdiv = 1 },   /* 65.000  MHz */
  97         { .mdiv = 0x05, .pe = 0x1770,   .sdiv = 0x3,    .nsdiv = 1 },   /* 71.000  MHz */
  98         { .mdiv = 0x03, .pe = 0x4ba7,   .sdiv = 0x3,    .nsdiv = 1 },   /* 74.176  MHz */
  99         { .mdiv = 0x0f, .pe = 0x3426,   .sdiv = 0x1,    .nsdiv = 0 },   /* 74.250  MHz */
 100         { .mdiv = 0x0e, .pe = 0x7777,   .sdiv = 0x1,    .nsdiv = 0 },   /* 75.000  MHz */
 101         { .mdiv = 0x01, .pe = 0x4053,   .sdiv = 0x3,    .nsdiv = 1 },   /* 78.800  MHz */
 102         { .mdiv = 0x09, .pe = 0x15b5,   .sdiv = 0x1,    .nsdiv = 0 },   /* 85.500  MHz */
 103         { .mdiv = 0x1b, .pe = 0x3f19,   .sdiv = 0x2,    .nsdiv = 1 },   /* 88.750  MHz */
 104         { .mdiv = 0x10, .pe = 0x71c7,   .sdiv = 0x2,    .nsdiv = 1 },   /* 108.000 MHz */
 105         { .mdiv = 0x00, .pe = 0x47af,   .sdiv = 0x1,    .nsdiv = 0 },   /* 108.108 MHz */
 106         { .mdiv = 0x0c, .pe = 0x3118,   .sdiv = 0x2,    .nsdiv = 1 },   /* 118.963 MHz */
 107         { .mdiv = 0x0c, .pe = 0x2f54,   .sdiv = 0x2,    .nsdiv = 1 },   /* 119.000 MHz */
 108         { .mdiv = 0x07, .pe = 0xe39,    .sdiv = 0x2,    .nsdiv = 1 },   /* 135.000 MHz */
 109         { .mdiv = 0x03, .pe = 0x4ba7,   .sdiv = 0x2,    .nsdiv = 1 },   /* 148.352 MHz */
 110         { .mdiv = 0x0f, .pe = 0x3426,   .sdiv = 0x0,    .nsdiv = 0 },   /* 148.500 MHz */
 111         { .mdiv = 0x03, .pe = 0x4ba7,   .sdiv = 0x1,    .nsdiv = 1 },   /* 296.704 MHz */
 112         { .mdiv = 0x03, .pe = 0x471c,   .sdiv = 0x1,    .nsdiv = 1 },   /* 297.000 MHz */
 113         { .mdiv = 0x00, .pe = 0x295f,   .sdiv = 0x1,    .nsdiv = 1 },   /* 326.700 MHz */
 114         { .mdiv = 0x1f, .pe = 0x3633,   .sdiv = 0x0,    .nsdiv = 1 },   /* 333.000 MHz */
 115         { .mdiv = 0x1c, .pe = 0x0,      .sdiv = 0x0,    .nsdiv = 1 },   /* 352.000 Mhz */
 116 };
 117
 118 struct clkgen_quadfs_data {
 119         bool reset_present;
 120         bool bwfilter_present;
 121         bool lockstatus_present;
 122         bool powerup_polarity;
 123         bool standby_polarity;
 124         bool nsdiv_present;
 125         bool nrst_present;
 126         struct clkgen_field ndiv;
 127         struct clkgen_field ref_bw;
 128         struct clkgen_field nreset;
 129         struct clkgen_field npda;
 130         struct clkgen_field lock_status;
 131
 132         struct clkgen_field nrst[QUADFS_MAX_CHAN];
 133         struct clkgen_field nsb[QUADFS_MAX_CHAN];
 134         struct clkgen_field en[QUADFS_MAX_CHAN];
 135         struct clkgen_field mdiv[QUADFS_MAX_CHAN];
 136         struct clkgen_field pe[QUADFS_MAX_CHAN];
 137         struct clkgen_field sdiv[QUADFS_MAX_CHAN];
 138         struct clkgen_field nsdiv[QUADFS_MAX_CHAN];
 139
 140         const struct clk_ops *pll_ops;
 141         const struct stm_fs *rtbl;
 142         u8 rtbl_cnt;
 143         int  (*get_rate)(unsigned long , const struct stm_fs *,
 144                         unsigned long *);
 145 };
 146
 147 static const struct clk_ops st_quadfs_pll_c65_ops;
 148 static const struct clk_ops st_quadfs_pll_c32_ops;
 149 static const struct clk_ops st_quadfs_fs216c65_ops;
 150 static const struct clk_ops st_quadfs_fs432c65_ops;
 151 static const struct clk_ops st_quadfs_fs660c32_ops;
 152
 153 static int clk_fs216c65_get_rate(unsigned long, const struct stm_fs *,
 154                 unsigned long *);
 155 static int clk_fs432c65_get_rate(unsigned long, const struct stm_fs *,
 156                 unsigned long *);
 157 static int clk_fs660c32_dig_get_rate(unsigned long, const struct stm_fs *,
 158                 unsigned long *);
 159 /*
 160  * Values for all of the standalone instances of this clock
 161  * generator found in STiH415 and STiH416 SYSCFG register banks. Note
 162  * that the individual channel standby control bits (nsb) are in the
 163  * first register along with the PLL control bits.
 164  */
 165 static const struct clkgen_quadfs_data st_fs216c65_416 = {
 166         /* 416 specific */
 167         .npda   = CLKGEN_FIELD(0x0, 0x1, 14),
 168         .nsb    = { CLKGEN_FIELD(0x0, 0x1, 10),
 169                     CLKGEN_FIELD(0x0, 0x1, 11),
 170                     CLKGEN_FIELD(0x0, 0x1, 12),
 171                     CLKGEN_FIELD(0x0, 0x1, 13) },
 172         .nsdiv_present = true,
 173         .nsdiv  = { CLKGEN_FIELD(0x0, 0x1, 18),
 174                     CLKGEN_FIELD(0x0, 0x1, 19),
 175                     CLKGEN_FIELD(0x0, 0x1, 20),
 176                     CLKGEN_FIELD(0x0, 0x1, 21) },
 177         .mdiv   = { CLKGEN_FIELD(0x4, 0x1f, 0),
 178                     CLKGEN_FIELD(0x14, 0x1f, 0),
 179                     CLKGEN_FIELD(0x24, 0x1f, 0),
 180                     CLKGEN_FIELD(0x34, 0x1f, 0) },
 181         .en     = { CLKGEN_FIELD(0x10, 0x1, 0),
 182                     CLKGEN_FIELD(0x20, 0x1, 0),
 183                     CLKGEN_FIELD(0x30, 0x1, 0),
 184                     CLKGEN_FIELD(0x40, 0x1, 0) },
 185         .ndiv   = CLKGEN_FIELD(0x0, 0x1, 15),
 186         .bwfilter_present = true,
 187         .ref_bw = CLKGEN_FIELD(0x0, 0x3, 16),
 188         .pe     = { CLKGEN_FIELD(0x8, 0xffff, 0),
 189                     CLKGEN_FIELD(0x18, 0xffff, 0),
 190                     CLKGEN_FIELD(0x28, 0xffff, 0),
 191                     CLKGEN_FIELD(0x38, 0xffff, 0) },
 192         .sdiv   = { CLKGEN_FIELD(0xC, 0x7, 0),
 193                     CLKGEN_FIELD(0x1C, 0x7, 0),
 194                     CLKGEN_FIELD(0x2C, 0x7, 0),
 195                     CLKGEN_FIELD(0x3C, 0x7, 0) },
 196         .pll_ops        = &st_quadfs_pll_c65_ops,
 197         .rtbl           = fs216c65_rtbl,
 198         .rtbl_cnt       = ARRAY_SIZE(fs216c65_rtbl),
 199         .get_rate       = clk_fs216c65_get_rate,
 200 };
 201
 202 static const struct clkgen_quadfs_data st_fs432c65_416 = {
 203         .npda   = CLKGEN_FIELD(0x0, 0x1, 14),
 204         .nsb    = { CLKGEN_FIELD(0x0, 0x1, 10),
 205                     CLKGEN_FIELD(0x0, 0x1, 11),
 206                     CLKGEN_FIELD(0x0, 0x1, 12),
 207                     CLKGEN_FIELD(0x0, 0x1, 13) },
 208         .nsdiv_present = true,
 209         .nsdiv  = { CLKGEN_FIELD(0x0, 0x1, 18),
 210                    CLKGEN_FIELD(0x0, 0x1, 19),
 211                    CLKGEN_FIELD(0x0, 0x1, 20),
 212                    CLKGEN_FIELD(0x0, 0x1, 21) },
 213         .mdiv   = { CLKGEN_FIELD(0x4, 0x1f, 0),
 214                     CLKGEN_FIELD(0x14, 0x1f, 0),
 215                     CLKGEN_FIELD(0x24, 0x1f, 0),
 216                     CLKGEN_FIELD(0x34, 0x1f, 0) },
 217         .en     = { CLKGEN_FIELD(0x10, 0x1, 0),
 218                     CLKGEN_FIELD(0x20, 0x1, 0),
 219                     CLKGEN_FIELD(0x30, 0x1, 0),
 220                     CLKGEN_FIELD(0x40, 0x1, 0) },
 221         .ndiv   = CLKGEN_FIELD(0x0, 0x1, 15),
 222         .bwfilter_present = true,
 223         .ref_bw = CLKGEN_FIELD(0x0, 0x3, 16),
 224         .pe     = { CLKGEN_FIELD(0x8, 0xffff, 0),
 225                     CLKGEN_FIELD(0x18, 0xffff, 0),
 226                     CLKGEN_FIELD(0x28, 0xffff, 0),
 227                     CLKGEN_FIELD(0x38, 0xffff, 0) },
 228         .sdiv   = { CLKGEN_FIELD(0xC, 0x7, 0),
 229                     CLKGEN_FIELD(0x1C, 0x7, 0),
 230                     CLKGEN_FIELD(0x2C, 0x7, 0),
 231                     CLKGEN_FIELD(0x3C, 0x7, 0) },
 232         .pll_ops        = &st_quadfs_pll_c65_ops,
 233         .rtbl           = fs432c65_rtbl,
 234         .rtbl_cnt       = ARRAY_SIZE(fs432c65_rtbl),
 235         .get_rate       = clk_fs432c65_get_rate,
 236 };
 237
 238 static const struct clkgen_quadfs_data st_fs660c32_E_416 = {
 239         .npda   = CLKGEN_FIELD(0x0, 0x1, 14),
 240         .nsb    = { CLKGEN_FIELD(0x0, 0x1, 10),
 241                     CLKGEN_FIELD(0x0, 0x1, 11),
 242                     CLKGEN_FIELD(0x0, 0x1, 12),
 243                     CLKGEN_FIELD(0x0, 0x1, 13) },
 244         .nsdiv_present = true,
 245         .nsdiv  = { CLKGEN_FIELD(0x0, 0x1, 18),
 246                     CLKGEN_FIELD(0x0, 0x1, 19),
 247                     CLKGEN_FIELD(0x0, 0x1, 20),
 248                     CLKGEN_FIELD(0x0, 0x1, 21) },
 249         .mdiv   = { CLKGEN_FIELD(0x4, 0x1f, 0),
 250                     CLKGEN_FIELD(0x14, 0x1f, 0),
 251                     CLKGEN_FIELD(0x24, 0x1f, 0),
 252                     CLKGEN_FIELD(0x34, 0x1f, 0) },
 253         .en     = { CLKGEN_FIELD(0x10, 0x1, 0),
 254                     CLKGEN_FIELD(0x20, 0x1, 0),
 255                     CLKGEN_FIELD(0x30, 0x1, 0),
 256                     CLKGEN_FIELD(0x40, 0x1, 0) },
 257         .ndiv   = CLKGEN_FIELD(0x0, 0x7, 15),
 258         .pe     = { CLKGEN_FIELD(0x8, 0x7fff, 0),
 259                     CLKGEN_FIELD(0x18, 0x7fff, 0),
 260                     CLKGEN_FIELD(0x28, 0x7fff, 0),
 261                     CLKGEN_FIELD(0x38, 0x7fff, 0) },
 262         .sdiv   = { CLKGEN_FIELD(0xC, 0xf, 0),
 263                     CLKGEN_FIELD(0x1C, 0xf, 0),
 264                     CLKGEN_FIELD(0x2C, 0xf, 0),
 265                     CLKGEN_FIELD(0x3C, 0xf, 0) },
 266         .lockstatus_present = true,
 267         .lock_status = CLKGEN_FIELD(0xAC, 0x1, 0),
 268         .pll_ops        = &st_quadfs_pll_c32_ops,
 269         .rtbl           = fs660c32_rtbl,
 270         .rtbl_cnt       = ARRAY_SIZE(fs660c32_rtbl),
 271         .get_rate       = clk_fs660c32_dig_get_rate,
 272 };
 273
 274 static const struct clkgen_quadfs_data st_fs660c32_F_416 = {
 275         .npda   = CLKGEN_FIELD(0x0, 0x1, 14),
 276         .nsb    = { CLKGEN_FIELD(0x0, 0x1, 10),
 277                     CLKGEN_FIELD(0x0, 0x1, 11),
 278                     CLKGEN_FIELD(0x0, 0x1, 12),
 279                     CLKGEN_FIELD(0x0, 0x1, 13) },
 280         .nsdiv_present = true,
 281         .nsdiv  = { CLKGEN_FIELD(0x0, 0x1, 18),
 282                     CLKGEN_FIELD(0x0, 0x1, 19),
 283                     CLKGEN_FIELD(0x0, 0x1, 20),
 284                     CLKGEN_FIELD(0x0, 0x1, 21) },
 285         .mdiv   = { CLKGEN_FIELD(0x4, 0x1f, 0),
 286                     CLKGEN_FIELD(0x14, 0x1f, 0),
 287                     CLKGEN_FIELD(0x24, 0x1f, 0),
 288                     CLKGEN_FIELD(0x34, 0x1f, 0) },
 289         .en     = { CLKGEN_FIELD(0x10, 0x1, 0),
 290                     CLKGEN_FIELD(0x20, 0x1, 0),
 291                     CLKGEN_FIELD(0x30, 0x1, 0),
 292                     CLKGEN_FIELD(0x40, 0x1, 0) },
 293         .ndiv   = CLKGEN_FIELD(0x0, 0x7, 15),
 294         .pe     = { CLKGEN_FIELD(0x8, 0x7fff, 0),
 295                     CLKGEN_FIELD(0x18, 0x7fff, 0),
 296                     CLKGEN_FIELD(0x28, 0x7fff, 0),
 297                     CLKGEN_FIELD(0x38, 0x7fff, 0) },
 298         .sdiv   = { CLKGEN_FIELD(0xC, 0xf, 0),
 299                     CLKGEN_FIELD(0x1C, 0xf, 0),
 300                     CLKGEN_FIELD(0x2C, 0xf, 0),
 301                     CLKGEN_FIELD(0x3C, 0xf, 0) },
 302         .lockstatus_present = true,
 303         .lock_status = CLKGEN_FIELD(0xEC, 0x1, 0),
 304         .pll_ops        = &st_quadfs_pll_c32_ops,
 305         .rtbl           = fs660c32_rtbl,
 306         .rtbl_cnt       = ARRAY_SIZE(fs660c32_rtbl),
 307         .get_rate       = clk_fs660c32_dig_get_rate,
 308 };
 309
 310 static const struct clkgen_quadfs_data st_fs660c32_C = {
 311         .nrst_present = true,
 312         .nrst   = { CLKGEN_FIELD(0x2f0, 0x1, 0),
 313                     CLKGEN_FIELD(0x2f0, 0x1, 1),
 314                     CLKGEN_FIELD(0x2f0, 0x1, 2),
 315                     CLKGEN_FIELD(0x2f0, 0x1, 3) },
 316         .npda   = CLKGEN_FIELD(0x2f0, 0x1, 12),
 317         .nsb    = { CLKGEN_FIELD(0x2f0, 0x1, 8),
 318                     CLKGEN_FIELD(0x2f0, 0x1, 9),
 319                     CLKGEN_FIELD(0x2f0, 0x1, 10),
 320                     CLKGEN_FIELD(0x2f0, 0x1, 11) },
 321         .nsdiv_present = true,
 322         .nsdiv  = { CLKGEN_FIELD(0x304, 0x1, 24),
 323                     CLKGEN_FIELD(0x308, 0x1, 24),
 324                     CLKGEN_FIELD(0x30c, 0x1, 24),
 325                     CLKGEN_FIELD(0x310, 0x1, 24) },
 326         .mdiv   = { CLKGEN_FIELD(0x304, 0x1f, 15),
 327                     CLKGEN_FIELD(0x308, 0x1f, 15),
 328                     CLKGEN_FIELD(0x30c, 0x1f, 15),
 329                     CLKGEN_FIELD(0x310, 0x1f, 15) },
 330         .en     = { CLKGEN_FIELD(0x2fc, 0x1, 0),
 331                     CLKGEN_FIELD(0x2fc, 0x1, 1),
 332                     CLKGEN_FIELD(0x2fc, 0x1, 2),
 333                     CLKGEN_FIELD(0x2fc, 0x1, 3) },
 334         .ndiv   = CLKGEN_FIELD(0x2f4, 0x7, 16),
 335         .pe     = { CLKGEN_FIELD(0x304, 0x7fff, 0),
 336                     CLKGEN_FIELD(0x308, 0x7fff, 0),
 337                     CLKGEN_FIELD(0x30c, 0x7fff, 0),
 338                     CLKGEN_FIELD(0x310, 0x7fff, 0) },
 339         .sdiv   = { CLKGEN_FIELD(0x304, 0xf, 20),
 340                     CLKGEN_FIELD(0x308, 0xf, 20),
 341                     CLKGEN_FIELD(0x30c, 0xf, 20),
 342                     CLKGEN_FIELD(0x310, 0xf, 20) },
 343         .lockstatus_present = true,
 344         .lock_status = CLKGEN_FIELD(0x2f0, 0x1, 24),
 345         .powerup_polarity = 1,
 346         .standby_polarity = 1,
 347         .pll_ops        = &st_quadfs_pll_c32_ops,
 348         .rtbl           = fs660c32_rtbl,
 349         .rtbl_cnt       = ARRAY_SIZE(fs660c32_rtbl),
 350         .get_rate       = clk_fs660c32_dig_get_rate,
 351 };
 352
 353 static const struct clkgen_quadfs_data st_fs660c32_D = {
 354         .nrst_present = true,
 355         .nrst   = { CLKGEN_FIELD(0x2a0, 0x1, 0),
 356                     CLKGEN_FIELD(0x2a0, 0x1, 1),
 357                     CLKGEN_FIELD(0x2a0, 0x1, 2),
 358                     CLKGEN_FIELD(0x2a0, 0x1, 3) },
 359         .ndiv   = CLKGEN_FIELD(0x2a4, 0x7, 16),
 360         .pe     = { CLKGEN_FIELD(0x2b4, 0x7fff, 0),
 361                     CLKGEN_FIELD(0x2b8, 0x7fff, 0),
 362                     CLKGEN_FIELD(0x2bc, 0x7fff, 0),
 363                     CLKGEN_FIELD(0x2c0, 0x7fff, 0) },
 364         .sdiv   = { CLKGEN_FIELD(0x2b4, 0xf, 20),
 365                     CLKGEN_FIELD(0x2b8, 0xf, 20),
 366                     CLKGEN_FIELD(0x2bc, 0xf, 20),
 367                     CLKGEN_FIELD(0x2c0, 0xf, 20) },
 368         .npda   = CLKGEN_FIELD(0x2a0, 0x1, 12),
 369         .nsb    = { CLKGEN_FIELD(0x2a0, 0x1, 8),
 370                     CLKGEN_FIELD(0x2a0, 0x1, 9),
 371                     CLKGEN_FIELD(0x2a0, 0x1, 10),
 372                     CLKGEN_FIELD(0x2a0, 0x1, 11) },
 373         .nsdiv_present = true,
 374         .nsdiv  = { CLKGEN_FIELD(0x2b4, 0x1, 24),
 375                     CLKGEN_FIELD(0x2b8, 0x1, 24),
 376                     CLKGEN_FIELD(0x2bc, 0x1, 24),
 377                     CLKGEN_FIELD(0x2c0, 0x1, 24) },
 378         .mdiv   = { CLKGEN_FIELD(0x2b4, 0x1f, 15),
 379                     CLKGEN_FIELD(0x2b8, 0x1f, 15),
 380                     CLKGEN_FIELD(0x2bc, 0x1f, 15),
 381                     CLKGEN_FIELD(0x2c0, 0x1f, 15) },
 382         .en     = { CLKGEN_FIELD(0x2ac, 0x1, 0),
 383                     CLKGEN_FIELD(0x2ac, 0x1, 1),
 384                     CLKGEN_FIELD(0x2ac, 0x1, 2),
 385                     CLKGEN_FIELD(0x2ac, 0x1, 3) },
 386         .lockstatus_present = true,
 387         .lock_status = CLKGEN_FIELD(0x2A0, 0x1, 24),
 388         .powerup_polarity = 1,
 389         .standby_polarity = 1,
 390         .pll_ops        = &st_quadfs_pll_c32_ops,
 391         .rtbl           = fs660c32_rtbl,
 392         .rtbl_cnt       = ARRAY_SIZE(fs660c32_rtbl),
 393         .get_rate       = clk_fs660c32_dig_get_rate,};
 394
 395 /**
 396  * DOC: A Frequency Synthesizer that multiples its input clock by a fixed factor
 397  *
 398  * Traits of this clock:
 399  * prepare - clk_(un)prepare only ensures parent is (un)prepared
 400  * enable - clk_enable and clk_disable are functional & control the Fsyn
 401  * rate - inherits rate from parent. set_rate/round_rate/recalc_rate
 402  * parent - fixed parent.  No clk_set_parent support
 403  */
 404
 405 /**
 406  * struct st_clk_quadfs_pll - A pll which outputs a fixed multiplier of
 407  *                                  its parent clock, found inside a type of
 408  *                                  ST quad channel frequency synthesizer block
 409  *
 410  * @hw: handle between common and hardware-specific interfaces.
 411  * @ndiv: regmap field for the ndiv control.
 412  * @regs_base: base address of the configuration registers.
 413  * @lock: spinlock.
 414  *
 415  */
 416 struct st_clk_quadfs_pll {
 417         struct clk_hw   hw;
 418         void __iomem    *regs_base;
 419         spinlock_t      *lock;
 420         struct clkgen_quadfs_data *data;
 421         u32 ndiv;
 422 };
 423
 424 #define to_quadfs_pll(_hw) container_of(_hw, struct st_clk_quadfs_pll, hw)
 425
 426 static int quadfs_pll_enable(struct clk_hw *hw)
 427 {
 428         struct st_clk_quadfs_pll *pll = to_quadfs_pll(hw);
 429         unsigned long flags = 0, timeout = jiffies + msecs_to_jiffies(10);
 430
 431         if (pll->lock)
 432                 spin_lock_irqsave(pll->lock, flags);
 433
 434         /*
 435          * Bring block out of reset if we have reset control.
 436          */
 437         if (pll->data->reset_present)
 438                 CLKGEN_WRITE(pll, nreset, 1);
 439
 440         /*
 441          * Use a fixed input clock noise bandwidth filter for the moment
 442          */
 443         if (pll->data->bwfilter_present)
 444                 CLKGEN_WRITE(pll, ref_bw, PLL_BW_GOODREF);
 445
 446
 447         CLKGEN_WRITE(pll, ndiv, pll->ndiv);
 448
 449         /*
 450          * Power up the PLL
 451          */
 452         CLKGEN_WRITE(pll, npda, !pll->data->powerup_polarity);
 453
 454         if (pll->lock)
 455                 spin_unlock_irqrestore(pll->lock, flags);
 456
 457         if (pll->data->lockstatus_present)
 458                 while (!CLKGEN_READ(pll, lock_status)) {
 459                         if (time_after(jiffies, timeout))
 460                                 return -ETIMEDOUT;
 461                         cpu_relax();
 462                 }
 463
 464         return 0;
 465 }
 466
 467 static void quadfs_pll_disable(struct clk_hw *hw)
 468 {
 469         struct st_clk_quadfs_pll *pll = to_quadfs_pll(hw);
 470         unsigned long flags = 0;
 471
 472         if (pll->lock)
 473                 spin_lock_irqsave(pll->lock, flags);
 474
 475         /*
 476          * Powerdown the PLL and then put block into soft reset if we have
 477          * reset control.
 478          */
 479         CLKGEN_WRITE(pll, npda, pll->data->powerup_polarity);
 480
 481         if (pll->data->reset_present)
 482                 CLKGEN_WRITE(pll, nreset, 0);
 483
 484         if (pll->lock)
 485                 spin_unlock_irqrestore(pll->lock, flags);
 486 }
 487
 488 static int quadfs_pll_is_enabled(struct clk_hw *hw)
 489 {
 490         struct st_clk_quadfs_pll *pll = to_quadfs_pll(hw);
 491         u32 npda = CLKGEN_READ(pll, npda);
 492
 493         return pll->data->powerup_polarity ? !npda : !!npda;
 494 }
 495
 496 static int clk_fs660c32_vco_get_rate(unsigned long input, struct stm_fs *fs,
 497                            unsigned long *rate)
 498 {
 499         unsigned long nd = fs->ndiv + 16; /* ndiv value */
 500
 501         *rate = input * nd;
 502
 503         return 0;
 504 }
 505
 506 static unsigned long quadfs_pll_fs660c32_recalc_rate(struct clk_hw *hw,
 507                                         unsigned long parent_rate)
 508 {
 509         struct st_clk_quadfs_pll *pll = to_quadfs_pll(hw);
 510         unsigned long rate = 0;
 511         struct stm_fs params;
 512
 513         params.ndiv = CLKGEN_READ(pll, ndiv);
 514         if (clk_fs660c32_vco_get_rate(parent_rate, &params, &rate))
 515                 pr_err("%s:%s error calculating rate\n",
 516                        clk_hw_get_name(hw), __func__);
 517
 518         pll->ndiv = params.ndiv;
 519
 520         return rate;
 521 }
 522
 523 static int clk_fs660c32_vco_get_params(unsigned long input,
 524                                 unsigned long output, struct stm_fs *fs)
 525 {
 526 /* Formula
 527    VCO frequency = (fin x ndiv) / pdiv
 528    ndiv = VCOfreq * pdiv / fin
 529    */
 530         unsigned long pdiv = 1, n;
 531
 532         /* Output clock range: 384Mhz to 660Mhz */
 533         if (output < 384000000 || output > 660000000)
 534                 return -EINVAL;
 535
 536         if (input > 40000000)
 537                 /* This means that PDIV would be 2 instead of 1.
 538                    Not supported today. */
 539                 return -EINVAL;
 540
 541         input /= 1000;
 542         output /= 1000;
 543
 544         n = output * pdiv / input;
 545         if (n < 16)
 546                 n = 16;
 547         fs->ndiv = n - 16; /* Converting formula value to reg value */
 548
 549         return 0;
 550 }
 551
 552 static long quadfs_pll_fs660c32_round_rate(struct clk_hw *hw,
 553                                            unsigned long rate,
 554                                            unsigned long *prate)
 555 {
 556         struct stm_fs params;
 557
 558         if (clk_fs660c32_vco_get_params(*prate, rate, &params))
 559                 return rate;
 560
 561         clk_fs660c32_vco_get_rate(*prate, &params, &rate);
 562
 563         pr_debug("%s: %s new rate %ld [ndiv=%u]\n",
 564                  __func__, clk_hw_get_name(hw),
 565                  rate, (unsigned int)params.ndiv);
 566
 567         return rate;
 568 }
 569
 570 static int quadfs_pll_fs660c32_set_rate(struct clk_hw *hw, unsigned long rate,
 571                                 unsigned long parent_rate)
 572 {
 573         struct st_clk_quadfs_pll *pll = to_quadfs_pll(hw);
 574         struct stm_fs params;
 575         long hwrate = 0;
 576         unsigned long flags = 0;
 577         int ret;
 578
 579         if (!rate || !parent_rate)
 580                 return -EINVAL;
 581
 582         ret = clk_fs660c32_vco_get_params(parent_rate, rate, &params);
 583         if (ret)
 584                 return ret;
 585
 586         clk_fs660c32_vco_get_rate(parent_rate, &params, &hwrate);
 587
 588         pr_debug("%s: %s new rate %ld [ndiv=0x%x]\n",
 589                  __func__, clk_hw_get_name(hw),
 590                  hwrate, (unsigned int)params.ndiv);
 591
 592         if (!hwrate)
 593                 return -EINVAL;
 594
 595         pll->ndiv = params.ndiv;
 596
 597         if (pll->lock)
 598                 spin_lock_irqsave(pll->lock, flags);
 599
 600         CLKGEN_WRITE(pll, ndiv, pll->ndiv);
 601
 602         if (pll->lock)
 603                 spin_unlock_irqrestore(pll->lock, flags);
 604
 605         return 0;
 606 }
 607
 608 static const struct clk_ops st_quadfs_pll_c65_ops = {
 609         .enable         = quadfs_pll_enable,
 610         .disable        = quadfs_pll_disable,
 611         .is_enabled     = quadfs_pll_is_enabled,
 612 };
 613
 614 static const struct clk_ops st_quadfs_pll_c32_ops = {
 615         .enable         = quadfs_pll_enable,
 616         .disable        = quadfs_pll_disable,
 617         .is_enabled     = quadfs_pll_is_enabled,
 618         .recalc_rate    = quadfs_pll_fs660c32_recalc_rate,
 619         .round_rate     = quadfs_pll_fs660c32_round_rate,
 620         .set_rate       = quadfs_pll_fs660c32_set_rate,
 621 };
 622
 623 static struct clk * __init st_clk_register_quadfs_pll(
 624                 const char *name, const char *parent_name,
 625                 struct clkgen_quadfs_data *quadfs, void __iomem *reg,
 626                 spinlock_t *lock)
 627 {
 628         struct st_clk_quadfs_pll *pll;
 629         struct clk *clk;
 630         struct clk_init_data init;
 631
 632         /*
 633          * Sanity check required pointers.
 634          */
 635         if (WARN_ON(!name || !parent_name))
 636                 return ERR_PTR(-EINVAL);
 637
 638         pll = kzalloc(sizeof(*pll), GFP_KERNEL);
 639         if (!pll)
 640                 return ERR_PTR(-ENOMEM);
 641
 642         init.name = name;
 643         init.ops = quadfs->pll_ops;
 644         init.flags = CLK_IS_BASIC | CLK_GET_RATE_NOCACHE;
 645         init.parent_names = &parent_name;
 646         init.num_parents = 1;
 647
 648         pll->data = quadfs;
 649         pll->regs_base = reg;
 650         pll->lock = lock;
 651         pll->hw.init = &init;
 652
 653         clk = clk_register(NULL, &pll->hw);
 654
 655         if (IS_ERR(clk))
 656                 kfree(pll);
 657
 658         return clk;
 659 }
 660
 661 /**
 662  * DOC: A digital frequency synthesizer
 663  *
 664  * Traits of this clock:
 665  * prepare - clk_(un)prepare only ensures parent is (un)prepared
 666  * enable - clk_enable and clk_disable are functional
 667  * rate - set rate is functional
 668  * parent - fixed parent.  No clk_set_parent support
 669  */
 670
 671 /**
 672  * struct st_clk_quadfs_fsynth - One clock output from a four channel digital
 673  *                                  frequency synthesizer (fsynth) block.
 674  *
 675  * @hw: handle between common and hardware-specific interfaces
 676  *
 677  * @nsb: regmap field in the output control register for the digital
 678  *       standby of this fsynth channel. This control is active low so
 679  *       the channel is in standby when the control bit is cleared.
 680  *
 681  * @nsdiv: regmap field in the output control register for
 682  *          for the optional divide by 3 of this fsynth channel. This control
 683  *          is active low so the divide by 3 is active when the control bit is
 684  *          cleared and the divide is bypassed when the bit is set.
 685  */
 686 struct st_clk_quadfs_fsynth {
 687         struct clk_hw   hw;
 688         void __iomem    *regs_base;
 689         spinlock_t      *lock;
 690         struct clkgen_quadfs_data *data;
 691
 692         u32 chan;
 693         /*
 694          * Cached hardware values from set_rate so we can program the
 695          * hardware in enable. There are two reasons for this:
 696          *
 697          *  1. The registers may not be writable until the parent has been
 698          *     enabled.
 699          *
 700          *  2. It restores the clock rate when a driver does an enable
 701          *     on PM restore, after a suspend to RAM has lost the hardware
 702          *     setup.
 703          */
 704         u32 md;
 705         u32 pe;
 706         u32 sdiv;
 707         u32 nsdiv;
 708 };
 709
 710 #define to_quadfs_fsynth(_hw) \
 711         container_of(_hw, struct st_clk_quadfs_fsynth, hw)
 712
 713 static void quadfs_fsynth_program_enable(struct st_clk_quadfs_fsynth *fs)
 714 {
 715         /*
 716          * Pulse the program enable register lsb to make the hardware take
 717          * notice of the new md/pe values with a glitchless transition.
 718          */
 719         CLKGEN_WRITE(fs, en[fs->chan], 1);
 720         CLKGEN_WRITE(fs, en[fs->chan], 0);
 721 }
 722
 723 static void quadfs_fsynth_program_rate(struct st_clk_quadfs_fsynth *fs)
 724 {
 725         unsigned long flags = 0;
 726
 727         /*
 728          * Ensure the md/pe parameters are ignored while we are
 729          * reprogramming them so we can get a glitchless change
 730          * when fine tuning the speed of a running clock.
 731          */
 732         CLKGEN_WRITE(fs, en[fs->chan], 0);
 733
 734         CLKGEN_WRITE(fs, mdiv[fs->chan], fs->md);
 735         CLKGEN_WRITE(fs, pe[fs->chan], fs->pe);
 736         CLKGEN_WRITE(fs, sdiv[fs->chan], fs->sdiv);
 737
 738         if (fs->lock)
 739                 spin_lock_irqsave(fs->lock, flags);
 740
 741         if (fs->data->nsdiv_present)
 742                 CLKGEN_WRITE(fs, nsdiv[fs->chan], fs->nsdiv);
 743
 744         if (fs->lock)
 745                 spin_unlock_irqrestore(fs->lock, flags);
 746 }
 747
 748 static int quadfs_fsynth_enable(struct clk_hw *hw)
 749 {
 750         struct st_clk_quadfs_fsynth *fs = to_quadfs_fsynth(hw);
 751         unsigned long flags = 0;
 752
 753         pr_debug("%s: %s\n", __func__, clk_hw_get_name(hw));
 754
 755         quadfs_fsynth_program_rate(fs);
 756
 757         if (fs->lock)
 758                 spin_lock_irqsave(fs->lock, flags);
 759
 760         CLKGEN_WRITE(fs, nsb[fs->chan], !fs->data->standby_polarity);
 761
 762         if (fs->data->nrst_present)
 763                 CLKGEN_WRITE(fs, nrst[fs->chan], 0);
 764
 765         if (fs->lock)
 766                 spin_unlock_irqrestore(fs->lock, flags);
 767
 768         quadfs_fsynth_program_enable(fs);
 769
 770         return 0;
 771 }
 772
 773 static void quadfs_fsynth_disable(struct clk_hw *hw)
 774 {
 775         struct st_clk_quadfs_fsynth *fs = to_quadfs_fsynth(hw);
 776         unsigned long flags = 0;
 777
 778         pr_debug("%s: %s\n", __func__, clk_hw_get_name(hw));
 779
 780         if (fs->lock)
 781                 spin_lock_irqsave(fs->lock, flags);
 782
 783         CLKGEN_WRITE(fs, nsb[fs->chan], fs->data->standby_polarity);
 784
 785         if (fs->lock)
 786                 spin_unlock_irqrestore(fs->lock, flags);
 787 }
 788
 789 static int quadfs_fsynth_is_enabled(struct clk_hw *hw)
 790 {
 791         struct st_clk_quadfs_fsynth *fs = to_quadfs_fsynth(hw);
 792         u32 nsb = CLKGEN_READ(fs, nsb[fs->chan]);
 793
 794         pr_debug("%s: %s enable bit = 0x%x\n",
 795                  __func__, clk_hw_get_name(hw), nsb);
 796
 797         return fs->data->standby_polarity ? !nsb : !!nsb;
 798 }
 799
 800 #define P15                     (uint64_t)(1 << 15)
 801
 802 static int clk_fs216c65_get_rate(unsigned long input, const struct stm_fs *fs,
 803                 unsigned long *rate)
 804 {
 805         uint64_t res;
 806         unsigned long ns;
 807         unsigned long nd = 8; /* ndiv stuck at 0 => val = 8 */
 808         unsigned long s;
 809         long m;
 810
 811         m = fs->mdiv - 32;
 812         s = 1 << (fs->sdiv + 1);
 813         ns = (fs->nsdiv ? 1 : 3);
 814
 815         res = (uint64_t)(s * ns * P15 * (uint64_t)(m + 33));
 816         res = res - (s * ns * fs->pe);
 817         *rate = div64_u64(P15 * nd * input * 32, res);
 818
 819         return 0;
 820 }
 821
 822 static int clk_fs432c65_get_rate(unsigned long input, const struct stm_fs *fs,
 823                 unsigned long *rate)
 824 {
 825         uint64_t res;
 826         unsigned long nd = 16; /* ndiv value; stuck at 0 (30Mhz input) */
 827         long m;
 828         unsigned long sd;
 829         unsigned long ns;
 830
 831         m = fs->mdiv - 32;
 832         sd = 1 << (fs->sdiv + 1);
 833         ns = (fs->nsdiv ? 1 : 3);
 834
 835         res = (uint64_t)(sd * ns * P15 * (uint64_t)(m + 33));
 836         res = res - (sd * ns * fs->pe);
 837         *rate = div64_u64(P15 * nd * input * 32, res);
 838
 839         return 0;
 840 }
 841
 842 #define P20             (uint64_t)(1 << 20)
 843
 844 static int clk_fs660c32_dig_get_rate(unsigned long input,
 845                                 const struct stm_fs *fs, unsigned long *rate)
 846 {
 847         unsigned long s = (1 << fs->sdiv);
 848         unsigned long ns;
 849         uint64_t res;
 850
 851         /*
 852          * 'nsdiv' is a register value ('BIN') which is translated
 853          * to a decimal value according to following rules.
 854          *
 855          *     nsdiv      ns.dec
 856          *       0        3
 857          *       1        1
 858          */
 859         ns = (fs->nsdiv == 1) ? 1 : 3;
 860
 861         res = (P20 * (32 + fs->mdiv) + 32 * fs->pe) * s * ns;
 862         *rate = (unsigned long)div64_u64(input * P20 * 32, res);
 863
 864         return 0;
 865 }
 866
 867 static int quadfs_fsynt_get_hw_value_for_recalc(struct st_clk_quadfs_fsynth *fs,
 868                 struct stm_fs *params)
 869 {
 870         /*
 871          * Get the initial hardware values for recalc_rate
 872          */
 873         params->mdiv    = CLKGEN_READ(fs, mdiv[fs->chan]);
 874         params->pe      = CLKGEN_READ(fs, pe[fs->chan]);
 875         params->sdiv    = CLKGEN_READ(fs, sdiv[fs->chan]);
 876
 877         if (fs->data->nsdiv_present)
 878                 params->nsdiv = CLKGEN_READ(fs, nsdiv[fs->chan]);
 879         else
 880                 params->nsdiv = 1;
 881
 882         /*
 883          * If All are NULL then assume no clock rate is programmed.
 884          */
 885         if (!params->mdiv && !params->pe && !params->sdiv)
 886                 return 1;
 887
 888         fs->md = params->mdiv;
 889         fs->pe = params->pe;
 890         fs->sdiv = params->sdiv;
 891         fs->nsdiv = params->nsdiv;
 892
 893         return 0;
 894 }
 895
 896 static long quadfs_find_best_rate(struct clk_hw *hw, unsigned long drate,
 897                                 unsigned long prate, struct stm_fs *params)
 898 {
 899         struct st_clk_quadfs_fsynth *fs = to_quadfs_fsynth(hw);
 900         int (*clk_fs_get_rate)(unsigned long ,
 901                                 const struct stm_fs *, unsigned long *);
 902         struct stm_fs prev_params;
 903         unsigned long prev_rate, rate = 0;
 904         unsigned long diff_rate, prev_diff_rate = ~0;
 905         int index;
 906
 907         clk_fs_get_rate = fs->data->get_rate;
 908
 909         for (index = 0; index < fs->data->rtbl_cnt; index++) {
 910                 prev_rate = rate;
 911
 912                 *params = fs->data->rtbl[index];
 913                 prev_params = *params;
 914
 915                 clk_fs_get_rate(prate, &fs->data->rtbl[index], &rate);
 916
 917                 diff_rate = abs(drate - rate);
 918
 919                 if (diff_rate > prev_diff_rate) {
 920                         rate = prev_rate;
 921                         *params = prev_params;
 922                         break;
 923                 }
 924
 925                 prev_diff_rate = diff_rate;
 926
 927                 if (drate == rate)
 928                         return rate;
 929         }
 930
 931
 932         if (index == fs->data->rtbl_cnt)
 933                 *params = prev_params;
 934
 935         return rate;
 936 }
 937
 938 static unsigned long quadfs_recalc_rate(struct clk_hw *hw,
 939                 unsigned long parent_rate)
 940 {
 941         struct st_clk_quadfs_fsynth *fs = to_quadfs_fsynth(hw);
 942         unsigned long rate = 0;
 943         struct stm_fs params;
 944         int (*clk_fs_get_rate)(unsigned long ,
 945                                 const struct stm_fs *, unsigned long *);
 946
 947         clk_fs_get_rate = fs->data->get_rate;
 948
 949         if (quadfs_fsynt_get_hw_value_for_recalc(fs, &params))
 950                 return 0;
 951
 952         if (clk_fs_get_rate(parent_rate, &params, &rate)) {
 953                 pr_err("%s:%s error calculating rate\n",
 954                        clk_hw_get_name(hw), __func__);
 955         }
 956
 957         pr_debug("%s:%s rate %lu\n", clk_hw_get_name(hw), __func__, rate);
 958
 959         return rate;
 960 }
 961
 962 static long quadfs_round_rate(struct clk_hw *hw, unsigned long rate,
 963                                      unsigned long *prate)
 964 {
 965         struct stm_fs params;
 966
 967         rate = quadfs_find_best_rate(hw, rate, *prate, &params);
 968
 969         pr_debug("%s: %s new rate %ld [sdiv=0x%x,md=0x%x,pe=0x%x,nsdiv3=%u]\n",
 970                  __func__, clk_hw_get_name(hw),
 971                  rate, (unsigned int)params.sdiv, (unsigned int)params.mdiv,
 972                          (unsigned int)params.pe, (unsigned int)params.nsdiv);
 973
 974         return rate;
 975 }
 976
 977
 978 static void quadfs_program_and_enable(struct st_clk_quadfs_fsynth *fs,
 979                 struct stm_fs *params)
 980 {
 981         fs->md = params->mdiv;
 982         fs->pe = params->pe;
 983         fs->sdiv = params->sdiv;
 984         fs->nsdiv = params->nsdiv;
 985
 986         /*
 987          * In some integrations you can only change the fsynth programming when
 988          * the parent entity containing it is enabled.
 989          */
 990         quadfs_fsynth_program_rate(fs);
 991         quadfs_fsynth_program_enable(fs);
 992 }
 993
 994 static int quadfs_set_rate(struct clk_hw *hw, unsigned long rate,
 995                                   unsigned long parent_rate)
 996 {
 997         struct st_clk_quadfs_fsynth *fs = to_quadfs_fsynth(hw);
 998         struct stm_fs params;
 999         long hwrate;
1000         int uninitialized_var(i);
1001
1002         if (!rate || !parent_rate)
1003                 return -EINVAL;
1004
1005         memset(&params, 0, sizeof(struct stm_fs));
1006
1007         hwrate = quadfs_find_best_rate(hw, rate, parent_rate, &params);
1008         if (!hwrate)
1009                 return -EINVAL;
1010
1011         quadfs_program_and_enable(fs, &params);
1012
1013         return 0;
1014 }
1015
1016
1017
1018 static const struct clk_ops st_quadfs_ops = {
1019         .enable         = quadfs_fsynth_enable,
1020         .disable        = quadfs_fsynth_disable,
1021         .is_enabled     = quadfs_fsynth_is_enabled,
1022         .round_rate     = quadfs_round_rate,
1023         .set_rate       = quadfs_set_rate,
1024         .recalc_rate    = quadfs_recalc_rate,
1025 };
1026
1027 static struct clk * __init st_clk_register_quadfs_fsynth(
1028                 const char *name, const char *parent_name,
1029                 struct clkgen_quadfs_data *quadfs, void __iomem *reg, u32 chan,
1030                 unsigned long flags, spinlock_t *lock)
1031 {
1032         struct st_clk_quadfs_fsynth *fs;
1033         struct clk *clk;
1034         struct clk_init_data init;
1035
1036         /*
1037          * Sanity check required pointers, note that nsdiv3 is optional.
1038          */
1039         if (WARN_ON(!name || !parent_name))
1040                 return ERR_PTR(-EINVAL);
1041
1042         fs = kzalloc(sizeof(*fs), GFP_KERNEL);
1043         if (!fs)
1044                 return ERR_PTR(-ENOMEM);
1045
1046         init.name = name;
1047         init.ops = &st_quadfs_ops;
1048         init.flags = flags | CLK_GET_RATE_NOCACHE | CLK_IS_BASIC;
1049         init.parent_names = &parent_name;
1050         init.num_parents = 1;
1051
1052         fs->data = quadfs;
1053         fs->regs_base = reg;
1054         fs->chan = chan;
1055         fs->lock = lock;
1056         fs->hw.init = &init;
1057
1058         clk = clk_register(NULL, &fs->hw);
1059
1060         if (IS_ERR(clk))
1061                 kfree(fs);
1062
1063         return clk;
1064 }
1065
1066 static const struct of_device_id quadfs_of_match[] = {
1067         {
1068                 .compatible = "st,stih416-quadfs216",
1069                 .data = &st_fs216c65_416
1070         },
1071         {
1072                 .compatible = "st,stih416-quadfs432",
1073                 .data = &st_fs432c65_416
1074         },
1075         {
1076                 .compatible = "st,stih416-quadfs660-E",
1077                 .data = &st_fs660c32_E_416
1078         },
1079         {
1080                 .compatible = "st,stih416-quadfs660-F",
1081                 .data = &st_fs660c32_F_416
1082         },
1083         {
1084                 .compatible = "st,stih407-quadfs660-C",
1085                 .data = &st_fs660c32_C
1086         },
1087         {
1088                 .compatible = "st,stih407-quadfs660-D",
1089                 .data = &st_fs660c32_D
1090         },
1091         {}
1092 };
1093
1094 static void __init st_of_create_quadfs_fsynths(
1095                 struct device_node *np, const char *pll_name,
1096                 struct clkgen_quadfs_data *quadfs, void __iomem *reg,
1097                 spinlock_t *lock)
1098 {
1099         struct clk_onecell_data *clk_data;
1100         int fschan;
1101
1102         clk_data = kzalloc(sizeof(*clk_data), GFP_KERNEL);
1103         if (!clk_data)
1104                 return;
1105
1106         clk_data->clk_num = QUADFS_MAX_CHAN;
1107         clk_data->clks = kzalloc(QUADFS_MAX_CHAN * sizeof(struct clk *),
1108                                  GFP_KERNEL);
1109
1110         if (!clk_data->clks) {
1111                 kfree(clk_data);
1112                 return;
1113         }
1114
1115         for (fschan = 0; fschan < QUADFS_MAX_CHAN; fschan++) {
1116                 struct clk *clk;
1117                 const char *clk_name;
1118                 unsigned long flags = 0;
1119
1120                 if (of_property_read_string_index(np, "clock-output-names",
1121                                                   fschan, &clk_name)) {
1122                         break;
1123                 }
1124
1125                 /*
1126                  * If we read an empty clock name then the channel is unused
1127                  */
1128                 if (*clk_name == '\0')
1129                         continue;
1130
1131                 of_clk_detect_critical(np, fschan, &flags);
1132
1133                 clk = st_clk_register_quadfs_fsynth(clk_name, pll_name,
1134                                                     quadfs, reg, fschan,
1135                                                     flags, lock);
1136
1137                 /*
1138                  * If there was an error registering this clock output, clean
1139                  * up and move on to the next one.
1140                  */
1141                 if (!IS_ERR(clk)) {
1142                         clk_data->clks[fschan] = clk;
1143                         pr_debug("%s: parent %s rate %u\n",
1144                                 __clk_get_name(clk),
1145                                 __clk_get_name(clk_get_parent(clk)),
1146                                 (unsigned int)clk_get_rate(clk));
1147                 }
1148         }
1149
1150         of_clk_add_provider(np, of_clk_src_onecell_get, clk_data);
1151 }
1152
1153 static void __init st_of_quadfs_setup(struct device_node *np)
1154 {
1155         const struct of_device_id *match;
1156         struct clk *clk;
1157         const char *pll_name, *clk_parent_name;
1158         void __iomem *reg;
1159         spinlock_t *lock;
1160
1161         match = of_match_node(quadfs_of_match, np);
1162         if (WARN_ON(!match))
1163                 return;
1164
1165         reg = of_iomap(np, 0);
1166         if (!reg)
1167                 return;
1168
1169         clk_parent_name = of_clk_get_parent_name(np, 0);
1170         if (!clk_parent_name)
1171                 return;
1172
1173         pll_name = kasprintf(GFP_KERNEL, "%s.pll", np->name);
1174         if (!pll_name)
1175                 return;
1176
1177         lock = kzalloc(sizeof(*lock), GFP_KERNEL);
1178         if (!lock)
1179                 goto err_exit;
1180
1181         spin_lock_init(lock);
1182
1183         clk = st_clk_register_quadfs_pll(pll_name, clk_parent_name,
1184                         (struct clkgen_quadfs_data *) match->data, reg, lock);
1185         if (IS_ERR(clk))
1186                 goto err_exit;
1187         else
1188                 pr_debug("%s: parent %s rate %u\n",
1189                         __clk_get_name(clk),
1190                         __clk_get_name(clk_get_parent(clk)),
1191                         (unsigned int)clk_get_rate(clk));
1192
1193         st_of_create_quadfs_fsynths(np, pll_name,
1194                                     (struct clkgen_quadfs_data *)match->data,
1195                                     reg, lock);
1196
1197 err_exit:
1198         kfree(pll_name); /* No longer need local copy of the PLL name */
1199 }
1200 CLK_OF_DECLARE(quadfs, "st,quadfs", st_of_quadfs_setup);