drivers/clk/davinci/da8xx-cfgchip.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  * Clock driver for DA8xx/AM17xx/AM18xx/OMAP-L13x CFGCHIP
   4  *
   5  * Copyright (C) 2018 David Lechner <david@lechnology.com>
   6  */
   7
   8 #include <linux/clk-provider.h>
   9 #include <linux/clk.h>
  10 #include <linux/clkdev.h>
  11 #include <linux/init.h>
  12 #include <linux/mfd/da8xx-cfgchip.h>
  13 #include <linux/mfd/syscon.h>
  14 #include <linux/of_device.h>
  15 #include <linux/of.h>
  16 #include <linux/platform_data/clk-da8xx-cfgchip.h>
  17 #include <linux/platform_device.h>
  18 #include <linux/regmap.h>
  19 #include <linux/slab.h>
  20
  21 /* --- Gate clocks --- */
  22
  23 #define DA8XX_GATE_CLOCK_IS_DIV4P5      BIT(1)
  24
  25 struct da8xx_cfgchip_gate_clk_info {
  26         const char *name;
  27         u32 cfgchip;
  28         u32 bit;
  29         u32 flags;
  30 };
  31
  32 struct da8xx_cfgchip_gate_clk {
  33         struct clk_hw hw;
  34         struct regmap *regmap;
  35         u32 reg;
  36         u32 mask;
  37 };
  38
  39 #define to_da8xx_cfgchip_gate_clk(_hw) \
  40         container_of((_hw), struct da8xx_cfgchip_gate_clk, hw)
  41
  42 static int da8xx_cfgchip_gate_clk_enable(struct clk_hw *hw)
  43 {
  44         struct da8xx_cfgchip_gate_clk *clk = to_da8xx_cfgchip_gate_clk(hw);
  45
  46         return regmap_write_bits(clk->regmap, clk->reg, clk->mask, clk->mask);
  47 }
  48
  49 static void da8xx_cfgchip_gate_clk_disable(struct clk_hw *hw)
  50 {
  51         struct da8xx_cfgchip_gate_clk *clk = to_da8xx_cfgchip_gate_clk(hw);
  52
  53         regmap_write_bits(clk->regmap, clk->reg, clk->mask, 0);
  54 }
  55
  56 static int da8xx_cfgchip_gate_clk_is_enabled(struct clk_hw *hw)
  57 {
  58         struct da8xx_cfgchip_gate_clk *clk = to_da8xx_cfgchip_gate_clk(hw);
  59         unsigned int val;
  60
  61         regmap_read(clk->regmap, clk->reg, &val);
  62
  63         return !!(val & clk->mask);
  64 }
  65
  66 static unsigned long da8xx_cfgchip_div4p5_recalc_rate(struct clk_hw *hw,
  67                                                       unsigned long parent_rate)
  68 {
  69         /* this clock divides by 4.5 */
  70         return parent_rate * 2 / 9;
  71 }
  72
  73 static const struct clk_ops da8xx_cfgchip_gate_clk_ops = {
  74         .enable         = da8xx_cfgchip_gate_clk_enable,
  75         .disable        = da8xx_cfgchip_gate_clk_disable,
  76         .is_enabled     = da8xx_cfgchip_gate_clk_is_enabled,
  77 };
  78
  79 static const struct clk_ops da8xx_cfgchip_div4p5_clk_ops = {
  80         .enable         = da8xx_cfgchip_gate_clk_enable,
  81         .disable        = da8xx_cfgchip_gate_clk_disable,
  82         .is_enabled     = da8xx_cfgchip_gate_clk_is_enabled,
  83         .recalc_rate    = da8xx_cfgchip_div4p5_recalc_rate,
  84 };
  85
  86 static struct da8xx_cfgchip_gate_clk * __init
  87 da8xx_cfgchip_gate_clk_register(struct device *dev,
  88                                 const struct da8xx_cfgchip_gate_clk_info *info,
  89                                 struct regmap *regmap)
  90 {
  91         struct clk *parent;
  92         const char *parent_name;
  93         struct da8xx_cfgchip_gate_clk *gate;
  94         struct clk_init_data init;
  95         int ret;
  96
  97         parent = devm_clk_get(dev, NULL);
  98         if (IS_ERR(parent))
  99                 return ERR_CAST(parent);
 100
 101         parent_name = __clk_get_name(parent);
 102
 103         gate = devm_kzalloc(dev, sizeof(*gate), GFP_KERNEL);
 104         if (!gate)
 105                 return ERR_PTR(-ENOMEM);
 106
 107         init.name = info->name;
 108         if (info->flags & DA8XX_GATE_CLOCK_IS_DIV4P5)
 109                 init.ops = &da8xx_cfgchip_div4p5_clk_ops;
 110         else
 111                 init.ops = &da8xx_cfgchip_gate_clk_ops;
 112         init.parent_names = &parent_name;
 113         init.num_parents = 1;
 114         init.flags = 0;
 115
 116         gate->hw.init = &init;
 117         gate->regmap = regmap;
 118         gate->reg = info->cfgchip;
 119         gate->mask = info->bit;
 120
 121         ret = devm_clk_hw_register(dev, &gate->hw);
 122         if (ret < 0)
 123                 return ERR_PTR(ret);
 124
 125         return gate;
 126 }
 127
 128 static const struct da8xx_cfgchip_gate_clk_info da8xx_tbclksync_info __initconst = {
 129         .name = "ehrpwm_tbclk",
 130         .cfgchip = CFGCHIP(1),
 131         .bit = CFGCHIP1_TBCLKSYNC,
 132 };
 133
 134 static int __init da8xx_cfgchip_register_tbclk(struct device *dev,
 135                                                struct regmap *regmap)
 136 {
 137         struct da8xx_cfgchip_gate_clk *gate;
 138
 139         gate = da8xx_cfgchip_gate_clk_register(dev, &da8xx_tbclksync_info,
 140                                                regmap);
 141         if (IS_ERR(gate))
 142                 return PTR_ERR(gate);
 143
 144         clk_hw_register_clkdev(&gate->hw, "tbclk", "ehrpwm.0");
 145         clk_hw_register_clkdev(&gate->hw, "tbclk", "ehrpwm.1");
 146
 147         return 0;
 148 }
 149
 150 static const struct da8xx_cfgchip_gate_clk_info da8xx_div4p5ena_info __initconst = {
 151         .name = "div4.5",
 152         .cfgchip = CFGCHIP(3),
 153         .bit = CFGCHIP3_DIV45PENA,
 154         .flags = DA8XX_GATE_CLOCK_IS_DIV4P5,
 155 };
 156
 157 static int __init da8xx_cfgchip_register_div4p5(struct device *dev,
 158                                                 struct regmap *regmap)
 159 {
 160         struct da8xx_cfgchip_gate_clk *gate;
 161
 162         gate = da8xx_cfgchip_gate_clk_register(dev, &da8xx_div4p5ena_info, regmap);
 163
 164         return PTR_ERR_OR_ZERO(gate);
 165 }
 166
 167 static int __init
 168 of_da8xx_cfgchip_gate_clk_init(struct device *dev,
 169                                const struct da8xx_cfgchip_gate_clk_info *info,
 170                                struct regmap *regmap)
 171 {
 172         struct da8xx_cfgchip_gate_clk *gate;
 173
 174         gate = da8xx_cfgchip_gate_clk_register(dev, info, regmap);
 175         if (IS_ERR(gate))
 176                 return PTR_ERR(gate);
 177
 178         return devm_of_clk_add_hw_provider(dev, of_clk_hw_simple_get, gate);
 179 }
 180
 181 static int __init of_da8xx_tbclksync_init(struct device *dev,
 182                                           struct regmap *regmap)
 183 {
 184         return of_da8xx_cfgchip_gate_clk_init(dev, &da8xx_tbclksync_info, regmap);
 185 }
 186
 187 static int __init of_da8xx_div4p5ena_init(struct device *dev,
 188                                           struct regmap *regmap)
 189 {
 190         return of_da8xx_cfgchip_gate_clk_init(dev, &da8xx_div4p5ena_info, regmap);
 191 }
 192
 193 /* --- MUX clocks --- */
 194
 195 struct da8xx_cfgchip_mux_clk_info {
 196         const char *name;
 197         const char *parent0;
 198         const char *parent1;
 199         u32 cfgchip;
 200         u32 bit;
 201 };
 202
 203 struct da8xx_cfgchip_mux_clk {
 204         struct clk_hw hw;
 205         struct regmap *regmap;
 206         u32 reg;
 207         u32 mask;
 208 };
 209
 210 #define to_da8xx_cfgchip_mux_clk(_hw) \
 211         container_of((_hw), struct da8xx_cfgchip_mux_clk, hw)
 212
 213 static int da8xx_cfgchip_mux_clk_set_parent(struct clk_hw *hw, u8 index)
 214 {
 215         struct da8xx_cfgchip_mux_clk *clk = to_da8xx_cfgchip_mux_clk(hw);
 216         unsigned int val = index ? clk->mask : 0;
 217
 218         return regmap_write_bits(clk->regmap, clk->reg, clk->mask, val);
 219 }
 220
 221 static u8 da8xx_cfgchip_mux_clk_get_parent(struct clk_hw *hw)
 222 {
 223         struct da8xx_cfgchip_mux_clk *clk = to_da8xx_cfgchip_mux_clk(hw);
 224         unsigned int val;
 225
 226         regmap_read(clk->regmap, clk->reg, &val);
 227
 228         return (val & clk->mask) ? 1 : 0;
 229 }
 230
 231 static const struct clk_ops da8xx_cfgchip_mux_clk_ops = {
 232         .set_parent     = da8xx_cfgchip_mux_clk_set_parent,
 233         .get_parent     = da8xx_cfgchip_mux_clk_get_parent,
 234 };
 235
 236 static struct da8xx_cfgchip_mux_clk * __init
 237 da8xx_cfgchip_mux_clk_register(struct device *dev,
 238                                const struct da8xx_cfgchip_mux_clk_info *info,
 239                                struct regmap *regmap)
 240 {
 241         const char * const parent_names[] = { info->parent0, info->parent1 };
 242         struct da8xx_cfgchip_mux_clk *mux;
 243         struct clk_init_data init;
 244         int ret;
 245
 246         mux = devm_kzalloc(dev, sizeof(*mux), GFP_KERNEL);
 247         if (!mux)
 248                 return ERR_PTR(-ENOMEM);
 249
 250         init.name = info->name;
 251         init.ops = &da8xx_cfgchip_mux_clk_ops;
 252         init.parent_names = parent_names;
 253         init.num_parents = 2;
 254         init.flags = 0;
 255
 256         mux->hw.init = &init;
 257         mux->regmap = regmap;
 258         mux->reg = info->cfgchip;
 259         mux->mask = info->bit;
 260
 261         ret = devm_clk_hw_register(dev, &mux->hw);
 262         if (ret < 0)
 263                 return ERR_PTR(ret);
 264
 265         return mux;
 266 }
 267
 268 static const struct da8xx_cfgchip_mux_clk_info da850_async1_info __initconst = {
 269         .name = "async1",
 270         .parent0 = "pll0_sysclk3",
 271         .parent1 = "div4.5",
 272         .cfgchip = CFGCHIP(3),
 273         .bit = CFGCHIP3_EMA_CLKSRC,
 274 };
 275
 276 static int __init da8xx_cfgchip_register_async1(struct device *dev,
 277                                                 struct regmap *regmap)
 278 {
 279         struct da8xx_cfgchip_mux_clk *mux;
 280
 281         mux = da8xx_cfgchip_mux_clk_register(dev, &da850_async1_info, regmap);
 282         if (IS_ERR(mux))
 283                 return PTR_ERR(mux);
 284
 285         clk_hw_register_clkdev(&mux->hw, "async1", "da850-psc0");
 286
 287         return 0;
 288 }
 289
 290 static const struct da8xx_cfgchip_mux_clk_info da850_async3_info __initconst = {
 291         .name = "async3",
 292         .parent0 = "pll0_sysclk2",
 293         .parent1 = "pll1_sysclk2",
 294         .cfgchip = CFGCHIP(3),
 295         .bit = CFGCHIP3_ASYNC3_CLKSRC,
 296 };
 297
 298 static int __init da850_cfgchip_register_async3(struct device *dev,
 299                                                 struct regmap *regmap)
 300 {
 301         struct da8xx_cfgchip_mux_clk *mux;
 302         struct clk_hw *parent;
 303
 304         mux = da8xx_cfgchip_mux_clk_register(dev, &da850_async3_info, regmap);
 305         if (IS_ERR(mux))
 306                 return PTR_ERR(mux);
 307
 308         clk_hw_register_clkdev(&mux->hw, "async3", "da850-psc1");
 309
 310         /* pll1_sysclk2 is not affected by CPU scaling, so use it for async3 */
 311         parent = clk_hw_get_parent_by_index(&mux->hw, 1);
 312         if (parent)
 313                 clk_set_parent(mux->hw.clk, parent->clk);
 314         else
 315                 dev_warn(dev, "Failed to find async3 parent clock\n");
 316
 317         return 0;
 318 }
 319
 320 static int __init
 321 of_da8xx_cfgchip_init_mux_clock(struct device *dev,
 322                                 const struct da8xx_cfgchip_mux_clk_info *info,
 323                                 struct regmap *regmap)
 324 {
 325         struct da8xx_cfgchip_mux_clk *mux;
 326
 327         mux = da8xx_cfgchip_mux_clk_register(dev, info, regmap);
 328         if (IS_ERR(mux))
 329                 return PTR_ERR(mux);
 330
 331         return devm_of_clk_add_hw_provider(dev, of_clk_hw_simple_get, &mux->hw);
 332 }
 333
 334 static int __init of_da850_async1_init(struct device *dev, struct regmap *regmap)
 335 {
 336         return of_da8xx_cfgchip_init_mux_clock(dev, &da850_async1_info, regmap);
 337 }
 338
 339 static int __init of_da850_async3_init(struct device *dev, struct regmap *regmap)
 340 {
 341         return of_da8xx_cfgchip_init_mux_clock(dev, &da850_async3_info, regmap);
 342 }
 343
 344 /* --- USB 2.0 PHY clock --- */
 345
 346 struct da8xx_usb0_clk48 {
 347         struct clk_hw hw;
 348         struct clk *fck;
 349         struct regmap *regmap;
 350 };
 351
 352 #define to_da8xx_usb0_clk48(_hw) \
 353         container_of((_hw), struct da8xx_usb0_clk48, hw)
 354
 355 static int da8xx_usb0_clk48_prepare(struct clk_hw *hw)
 356 {
 357         struct da8xx_usb0_clk48 *usb0 = to_da8xx_usb0_clk48(hw);
 358
 359         /* The USB 2.0 PSC clock is only needed temporarily during the USB 2.0
 360          * PHY clock enable, but since clk_prepare() can't be called in an
 361          * atomic context (i.e. in clk_enable()), we have to prepare it here.
 362          */
 363         return clk_prepare(usb0->fck);
 364 }
 365
 366 static void da8xx_usb0_clk48_unprepare(struct clk_hw *hw)
 367 {
 368         struct da8xx_usb0_clk48 *usb0 = to_da8xx_usb0_clk48(hw);
 369
 370         clk_unprepare(usb0->fck);
 371 }
 372
 373 static int da8xx_usb0_clk48_enable(struct clk_hw *hw)
 374 {
 375         struct da8xx_usb0_clk48 *usb0 = to_da8xx_usb0_clk48(hw);
 376         unsigned int mask, val;
 377         int ret;
 378
 379         /* Locking the USB 2.O PLL requires that the USB 2.O PSC is enabled
 380          * temporaily. It can be turned back off once the PLL is locked.
 381          */
 382         clk_enable(usb0->fck);
 383
 384         /* Turn on the USB 2.0 PHY, but just the PLL, and not OTG. The USB 1.1
 385          * PHY may use the USB 2.0 PLL clock without USB 2.0 OTG being used.
 386          */
 387         mask = CFGCHIP2_RESET | CFGCHIP2_PHYPWRDN | CFGCHIP2_PHY_PLLON;
 388         val = CFGCHIP2_PHY_PLLON;
 389
 390         regmap_write_bits(usb0->regmap, CFGCHIP(2), mask, val);
 391         ret = regmap_read_poll_timeout(usb0->regmap, CFGCHIP(2), val,
 392                                        val & CFGCHIP2_PHYCLKGD, 0, 500000);
 393
 394         clk_disable(usb0->fck);
 395
 396         return ret;
 397 }
 398
 399 static void da8xx_usb0_clk48_disable(struct clk_hw *hw)
 400 {
 401         struct da8xx_usb0_clk48 *usb0 = to_da8xx_usb0_clk48(hw);
 402         unsigned int val;
 403
 404         val = CFGCHIP2_PHYPWRDN;
 405         regmap_write_bits(usb0->regmap, CFGCHIP(2), val, val);
 406 }
 407
 408 static int da8xx_usb0_clk48_is_enabled(struct clk_hw *hw)
 409 {
 410         struct da8xx_usb0_clk48 *usb0 = to_da8xx_usb0_clk48(hw);
 411         unsigned int val;
 412
 413         regmap_read(usb0->regmap, CFGCHIP(2), &val);
 414
 415         return !!(val & CFGCHIP2_PHYCLKGD);
 416 }
 417
 418 static unsigned long da8xx_usb0_clk48_recalc_rate(struct clk_hw *hw,
 419                                                   unsigned long parent_rate)
 420 {
 421         struct da8xx_usb0_clk48 *usb0 = to_da8xx_usb0_clk48(hw);
 422         unsigned int mask, val;
 423
 424         /* The parent clock rate must be one of the following */
 425         mask = CFGCHIP2_REFFREQ_MASK;
 426         switch (parent_rate) {
 427         case 12000000:
 428                 val = CFGCHIP2_REFFREQ_12MHZ;
 429                 break;
 430         case 13000000:
 431                 val = CFGCHIP2_REFFREQ_13MHZ;
 432                 break;
 433         case 19200000:
 434                 val = CFGCHIP2_REFFREQ_19_2MHZ;
 435                 break;
 436         case 20000000:
 437                 val = CFGCHIP2_REFFREQ_20MHZ;
 438                 break;
 439         case 24000000:
 440                 val = CFGCHIP2_REFFREQ_24MHZ;
 441                 break;
 442         case 26000000:
 443                 val = CFGCHIP2_REFFREQ_26MHZ;
 444                 break;
 445         case 38400000:
 446                 val = CFGCHIP2_REFFREQ_38_4MHZ;
 447                 break;
 448         case 40000000:
 449                 val = CFGCHIP2_REFFREQ_40MHZ;
 450                 break;
 451         case 48000000:
 452                 val = CFGCHIP2_REFFREQ_48MHZ;
 453                 break;
 454         default:
 455                 return 0;
 456         }
 457
 458         regmap_write_bits(usb0->regmap, CFGCHIP(2), mask, val);
 459
 460         /* USB 2.0 PLL always supplies 48MHz */
 461         return 48000000;
 462 }
 463
 464 static long da8xx_usb0_clk48_round_rate(struct clk_hw *hw, unsigned long rate,
 465                                         unsigned long *parent_rate)
 466 {
 467         return 48000000;
 468 }
 469
 470 static int da8xx_usb0_clk48_set_parent(struct clk_hw *hw, u8 index)
 471 {
 472         struct da8xx_usb0_clk48 *usb0 = to_da8xx_usb0_clk48(hw);
 473
 474         return regmap_write_bits(usb0->regmap, CFGCHIP(2),
 475                                  CFGCHIP2_USB2PHYCLKMUX,
 476                                  index ? CFGCHIP2_USB2PHYCLKMUX : 0);
 477 }
 478
 479 static u8 da8xx_usb0_clk48_get_parent(struct clk_hw *hw)
 480 {
 481         struct da8xx_usb0_clk48 *usb0 = to_da8xx_usb0_clk48(hw);
 482         unsigned int val;
 483
 484         regmap_read(usb0->regmap, CFGCHIP(2), &val);
 485
 486         return (val & CFGCHIP2_USB2PHYCLKMUX) ? 1 : 0;
 487 }
 488
 489 static const struct clk_ops da8xx_usb0_clk48_ops = {
 490         .prepare        = da8xx_usb0_clk48_prepare,
 491         .unprepare      = da8xx_usb0_clk48_unprepare,
 492         .enable         = da8xx_usb0_clk48_enable,
 493         .disable        = da8xx_usb0_clk48_disable,
 494         .is_enabled     = da8xx_usb0_clk48_is_enabled,
 495         .recalc_rate    = da8xx_usb0_clk48_recalc_rate,
 496         .round_rate     = da8xx_usb0_clk48_round_rate,
 497         .set_parent     = da8xx_usb0_clk48_set_parent,
 498         .get_parent     = da8xx_usb0_clk48_get_parent,
 499 };
 500
 501 static struct da8xx_usb0_clk48 *
 502 da8xx_cfgchip_register_usb0_clk48(struct device *dev,
 503                                   struct regmap *regmap)
 504 {
 505         const char * const parent_names[] = { "usb_refclkin", "pll0_auxclk" };
 506         struct clk *fck_clk;
 507         struct da8xx_usb0_clk48 *usb0;
 508         struct clk_init_data init;
 509         int ret;
 510
 511         fck_clk = devm_clk_get(dev, "fck");
 512         if (IS_ERR(fck_clk)) {
 513                 if (PTR_ERR(fck_clk) != -EPROBE_DEFER)
 514                         dev_err(dev, "Missing fck clock\n");
 515                 return ERR_CAST(fck_clk);
 516         }
 517
 518         usb0 = devm_kzalloc(dev, sizeof(*usb0), GFP_KERNEL);
 519         if (!usb0)
 520                 return ERR_PTR(-ENOMEM);
 521
 522         init.name = "usb0_clk48";
 523         init.ops = &da8xx_usb0_clk48_ops;
 524         init.parent_names = parent_names;
 525         init.num_parents = 2;
 526
 527         usb0->hw.init = &init;
 528         usb0->fck = fck_clk;
 529         usb0->regmap = regmap;
 530
 531         ret = devm_clk_hw_register(dev, &usb0->hw);
 532         if (ret < 0)
 533                 return ERR_PTR(ret);
 534
 535         return usb0;
 536 }
 537
 538 /* --- USB 1.1 PHY clock --- */
 539
 540 struct da8xx_usb1_clk48 {
 541         struct clk_hw hw;
 542         struct regmap *regmap;
 543 };
 544
 545 #define to_da8xx_usb1_clk48(_hw) \
 546         container_of((_hw), struct da8xx_usb1_clk48, hw)
 547
 548 static int da8xx_usb1_clk48_set_parent(struct clk_hw *hw, u8 index)
 549 {
 550         struct da8xx_usb1_clk48 *usb1 = to_da8xx_usb1_clk48(hw);
 551
 552         return regmap_write_bits(usb1->regmap, CFGCHIP(2),
 553                                  CFGCHIP2_USB1PHYCLKMUX,
 554                                  index ? CFGCHIP2_USB1PHYCLKMUX : 0);
 555 }
 556
 557 static u8 da8xx_usb1_clk48_get_parent(struct clk_hw *hw)
 558 {
 559         struct da8xx_usb1_clk48 *usb1 = to_da8xx_usb1_clk48(hw);
 560         unsigned int val;
 561
 562         regmap_read(usb1->regmap, CFGCHIP(2), &val);
 563
 564         return (val & CFGCHIP2_USB1PHYCLKMUX) ? 1 : 0;
 565 }
 566
 567 static const struct clk_ops da8xx_usb1_clk48_ops = {
 568         .set_parent     = da8xx_usb1_clk48_set_parent,
 569         .get_parent     = da8xx_usb1_clk48_get_parent,
 570 };
 571
 572 /**
 573  * da8xx_cfgchip_register_usb1_clk48 - Register a new USB 1.1 PHY clock
 574  * @regmap: The CFGCHIP regmap
 575  */
 576 static struct da8xx_usb1_clk48 *
 577 da8xx_cfgchip_register_usb1_clk48(struct device *dev,
 578                                   struct regmap *regmap)
 579 {
 580         const char * const parent_names[] = { "usb0_clk48", "usb_refclkin" };
 581         struct da8xx_usb1_clk48 *usb1;
 582         struct clk_init_data init;
 583         int ret;
 584
 585         usb1 = devm_kzalloc(dev, sizeof(*usb1), GFP_KERNEL);
 586         if (!usb1)
 587                 return ERR_PTR(-ENOMEM);
 588
 589         init.name = "usb1_clk48";
 590         init.ops = &da8xx_usb1_clk48_ops;
 591         init.parent_names = parent_names;
 592         init.num_parents = 2;
 593
 594         usb1->hw.init = &init;
 595         usb1->regmap = regmap;
 596
 597         ret = devm_clk_hw_register(dev, &usb1->hw);
 598         if (ret < 0)
 599                 return ERR_PTR(ret);
 600
 601         return usb1;
 602 }
 603
 604 static int da8xx_cfgchip_register_usb_phy_clk(struct device *dev,
 605                                               struct regmap *regmap)
 606 {
 607         struct da8xx_usb0_clk48 *usb0;
 608         struct da8xx_usb1_clk48 *usb1;
 609         struct clk_hw *parent;
 610
 611         usb0 = da8xx_cfgchip_register_usb0_clk48(dev, regmap);
 612         if (IS_ERR(usb0))
 613                 return PTR_ERR(usb0);
 614
 615         /*
 616          * All existing boards use pll0_auxclk as the parent and new boards
 617          * should use device tree, so hard-coding the value (1) here.
 618          */
 619         parent = clk_hw_get_parent_by_index(&usb0->hw, 1);
 620         if (parent)
 621                 clk_set_parent(usb0->hw.clk, parent->clk);
 622         else
 623                 dev_warn(dev, "Failed to find usb0 parent clock\n");
 624
 625         usb1 = da8xx_cfgchip_register_usb1_clk48(dev, regmap);
 626         if (IS_ERR(usb1))
 627                 return PTR_ERR(usb1);
 628
 629         /*
 630          * All existing boards use usb0_clk48 as the parent and new boards
 631          * should use device tree, so hard-coding the value (0) here.
 632          */
 633         parent = clk_hw_get_parent_by_index(&usb1->hw, 0);
 634         if (parent)
 635                 clk_set_parent(usb1->hw.clk, parent->clk);
 636         else
 637                 dev_warn(dev, "Failed to find usb1 parent clock\n");
 638
 639         clk_hw_register_clkdev(&usb0->hw, "usb0_clk48", "da8xx-usb-phy");
 640         clk_hw_register_clkdev(&usb1->hw, "usb1_clk48", "da8xx-usb-phy");
 641
 642         return 0;
 643 }
 644
 645 static int of_da8xx_usb_phy_clk_init(struct device *dev, struct regmap *regmap)
 646 {
 647         struct clk_hw_onecell_data *clk_data;
 648         struct da8xx_usb0_clk48 *usb0;
 649         struct da8xx_usb1_clk48 *usb1;
 650
 651         clk_data = devm_kzalloc(dev, struct_size(clk_data, hws, 2),
 652                                 GFP_KERNEL);
 653         if (!clk_data)
 654                 return -ENOMEM;
 655
 656         clk_data->num = 2;
 657
 658         usb0 = da8xx_cfgchip_register_usb0_clk48(dev, regmap);
 659         if (IS_ERR(usb0)) {
 660                 if (PTR_ERR(usb0) == -EPROBE_DEFER)
 661                         return -EPROBE_DEFER;
 662
 663                 dev_warn(dev, "Failed to register usb0_clk48 (%ld)\n",
 664                          PTR_ERR(usb0));
 665
 666                 clk_data->hws[0] = ERR_PTR(-ENOENT);
 667         } else {
 668                 clk_data->hws[0] = &usb0->hw;
 669         }
 670
 671         usb1 = da8xx_cfgchip_register_usb1_clk48(dev, regmap);
 672         if (IS_ERR(usb1)) {
 673                 if (PTR_ERR(usb1) == -EPROBE_DEFER)
 674                         return -EPROBE_DEFER;
 675
 676                 dev_warn(dev, "Failed to register usb1_clk48 (%ld)\n",
 677                          PTR_ERR(usb1));
 678
 679                 clk_data->hws[1] = ERR_PTR(-ENOENT);
 680         } else {
 681                 clk_data->hws[1] = &usb1->hw;
 682         }
 683
 684         return devm_of_clk_add_hw_provider(dev, of_clk_hw_onecell_get, clk_data);
 685 }
 686
 687 /* --- platform device --- */
 688
 689 static const struct of_device_id da8xx_cfgchip_of_match[] = {
 690         {
 691                 .compatible = "ti,da830-tbclksync",
 692                 .data = of_da8xx_tbclksync_init,
 693         },
 694         {
 695                 .compatible = "ti,da830-div4p5ena",
 696                 .data = of_da8xx_div4p5ena_init,
 697         },
 698         {
 699                 .compatible = "ti,da850-async1-clksrc",
 700                 .data = of_da850_async1_init,
 701         },
 702         {
 703                 .compatible = "ti,da850-async3-clksrc",
 704                 .data = of_da850_async3_init,
 705         },
 706         {
 707                 .compatible = "ti,da830-usb-phy-clocks",
 708                 .data = of_da8xx_usb_phy_clk_init,
 709         },
 710         { }
 711 };
 712
 713 static const struct platform_device_id da8xx_cfgchip_id_table[] = {
 714         {
 715                 .name = "da830-tbclksync",
 716                 .driver_data = (kernel_ulong_t)da8xx_cfgchip_register_tbclk,
 717         },
 718         {
 719                 .name = "da830-div4p5ena",
 720                 .driver_data = (kernel_ulong_t)da8xx_cfgchip_register_div4p5,
 721         },
 722         {
 723                 .name = "da850-async1-clksrc",
 724                 .driver_data = (kernel_ulong_t)da8xx_cfgchip_register_async1,
 725         },
 726         {
 727                 .name = "da850-async3-clksrc",
 728                 .driver_data = (kernel_ulong_t)da850_cfgchip_register_async3,
 729         },
 730         {
 731                 .name = "da830-usb-phy-clks",
 732                 .driver_data = (kernel_ulong_t)da8xx_cfgchip_register_usb_phy_clk,
 733         },
 734         { }
 735 };
 736
 737 typedef int (*da8xx_cfgchip_init)(struct device *dev, struct regmap *regmap);
 738
 739 static int da8xx_cfgchip_probe(struct platform_device *pdev)
 740 {
 741         struct device *dev = &pdev->dev;
 742         struct da8xx_cfgchip_clk_platform_data *pdata = dev->platform_data;
 743         const struct of_device_id *of_id;
 744         da8xx_cfgchip_init clk_init = NULL;
 745         struct regmap *regmap = NULL;
 746
 747         of_id = of_match_device(da8xx_cfgchip_of_match, dev);
 748         if (of_id) {
 749                 struct device_node *parent;
 750
 751                 clk_init = of_id->data;
 752                 parent = of_get_parent(dev->of_node);
 753                 regmap = syscon_node_to_regmap(parent);
 754                 of_node_put(parent);
 755         } else if (pdev->id_entry && pdata) {
 756                 clk_init = (void *)pdev->id_entry->driver_data;
 757                 regmap = pdata->cfgchip;
 758         }
 759
 760         if (!clk_init) {
 761                 dev_err(dev, "unable to find driver data\n");
 762                 return -EINVAL;
 763         }
 764
 765         if (IS_ERR_OR_NULL(regmap)) {
 766                 dev_err(dev, "no regmap for CFGCHIP syscon\n");
 767                 return regmap ? PTR_ERR(regmap) : -ENOENT;
 768         }
 769
 770         return clk_init(dev, regmap);
 771 }
 772
 773 static struct platform_driver da8xx_cfgchip_driver = {
 774         .probe          = da8xx_cfgchip_probe,
 775         .driver         = {
 776                 .name           = "da8xx-cfgchip-clk",
 777                 .of_match_table = da8xx_cfgchip_of_match,
 778         },
 779         .id_table       = da8xx_cfgchip_id_table,
 780 };
 781
 782 static int __init da8xx_cfgchip_driver_init(void)
 783 {
 784         return platform_driver_register(&da8xx_cfgchip_driver);
 785 }
 786
 787 /* has to be postcore_initcall because PSC devices depend on the async3 clock */
 788 postcore_initcall(da8xx_cfgchip_driver_init);