hc
2024-01-05 071106ecf68c401173c58808b1cf5f68cc50d390
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
// SPDX-License-Identifier: GPL-2.0-only
/*
 * Clock driver for the ARM Integrator/AP, Integrator/CP, Versatile AB and
 * Versatile PB boards.
 * Copyright (C) 2012 Linus Walleij
 */
#include <linux/clk-provider.h>
#include <linux/err.h>
#include <linux/of.h>
#include <linux/of_address.h>
 
#include "icst.h"
#include "clk-icst.h"
 
#define INTEGRATOR_HDR_LOCK_OFFSET    0x14
 
#define VERSATILE_SYS_OSCCLCD_OFFSET    0x1c
#define VERSATILE_SYS_LOCK_OFFSET    0x20
 
/* Base offset for the core module */
static void __iomem *cm_base;
 
static const struct icst_params cp_auxosc_params = {
   .vco_max    = ICST525_VCO_MAX_5V,
   .vco_min    = ICST525_VCO_MIN,
   .vd_min     = 8,
   .vd_max     = 263,
   .rd_min     = 3,
   .rd_max     = 65,
   .s2div        = icst525_s2div,
   .idx2s        = icst525_idx2s,
};
 
static const struct clk_icst_desc cm_auxosc_desc __initconst = {
   .params = &cp_auxosc_params,
   .vco_offset = 0x1c,
   .lock_offset = INTEGRATOR_HDR_LOCK_OFFSET,
};
 
static const struct icst_params versatile_auxosc_params = {
   .vco_max    = ICST307_VCO_MAX,
   .vco_min    = ICST307_VCO_MIN,
   .vd_min        = 4 + 8,
   .vd_max        = 511 + 8,
   .rd_min        = 1 + 2,
   .rd_max        = 127 + 2,
   .s2div        = icst307_s2div,
   .idx2s        = icst307_idx2s,
};
 
static const struct clk_icst_desc versatile_auxosc_desc __initconst = {
   .params = &versatile_auxosc_params,
   .vco_offset = VERSATILE_SYS_OSCCLCD_OFFSET,
   .lock_offset = VERSATILE_SYS_LOCK_OFFSET,
};
static void __init cm_osc_setup(struct device_node *np,
               const struct clk_icst_desc *desc)
{
   struct clk *clk;
   const char *clk_name = np->name;
   const char *parent_name;
 
   if (!cm_base) {
       /* Remap the core module base if not done yet */
       struct device_node *parent;
 
       parent = of_get_parent(np);
       if (!parent) {
           pr_err("no parent on core module clock\n");
           return;
       }
       cm_base = of_iomap(parent, 0);
       of_node_put(parent);
       if (!cm_base) {
           pr_err("could not remap core module base\n");
           return;
       }
   }
 
   parent_name = of_clk_get_parent_name(np, 0);
   clk = icst_clk_register(NULL, desc, clk_name, parent_name, cm_base);
   if (!IS_ERR(clk))
       of_clk_add_provider(np, of_clk_src_simple_get, clk);
}
 
static void __init of_integrator_cm_osc_setup(struct device_node *np)
{
   cm_osc_setup(np, &cm_auxosc_desc);
}
CLK_OF_DECLARE(integrator_cm_auxosc_clk,
   "arm,integrator-cm-auxosc", of_integrator_cm_osc_setup);
 
static void __init of_versatile_cm_osc_setup(struct device_node *np)
{
   cm_osc_setup(np, &versatile_auxosc_desc);
}
CLK_OF_DECLARE(versatile_cm_auxosc_clk,
          "arm,versatile-cm-auxosc", of_versatile_cm_osc_setup);