Loading...
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 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 | // SPDX-License-Identifier: GPL-2.0 #include <linux/io.h> #include <linux/clk-provider.h> #include <linux/slab.h> #include <linux/of.h> #include <linux/of_address.h> #include "clk.h" void mmp_clk_init(struct device_node *np, struct mmp_clk_unit *unit, int nr_clks) { struct clk **clk_table; clk_table = kcalloc(nr_clks, sizeof(struct clk *), GFP_KERNEL); if (!clk_table) return; unit->clk_table = clk_table; unit->nr_clks = nr_clks; unit->clk_data.clks = clk_table; unit->clk_data.clk_num = nr_clks; of_clk_add_provider(np, of_clk_src_onecell_get, &unit->clk_data); } void mmp_register_fixed_rate_clks(struct mmp_clk_unit *unit, struct mmp_param_fixed_rate_clk *clks, int size) { int i; struct clk *clk; for (i = 0; i < size; i++) { clk = clk_register_fixed_rate(NULL, clks[i].name, clks[i].parent_name, clks[i].flags, clks[i].fixed_rate); if (IS_ERR(clk)) { pr_err("%s: failed to register clock %s\n", __func__, clks[i].name); continue; } if (clks[i].id) unit->clk_table[clks[i].id] = clk; } } void mmp_register_fixed_factor_clks(struct mmp_clk_unit *unit, struct mmp_param_fixed_factor_clk *clks, int size) { struct clk *clk; int i; for (i = 0; i < size; i++) { clk = clk_register_fixed_factor(NULL, clks[i].name, clks[i].parent_name, clks[i].flags, clks[i].mult, clks[i].div); if (IS_ERR(clk)) { pr_err("%s: failed to register clock %s\n", __func__, clks[i].name); continue; } if (clks[i].id) unit->clk_table[clks[i].id] = clk; } } void mmp_register_general_gate_clks(struct mmp_clk_unit *unit, struct mmp_param_general_gate_clk *clks, void __iomem *base, int size) { struct clk *clk; int i; for (i = 0; i < size; i++) { clk = clk_register_gate(NULL, clks[i].name, clks[i].parent_name, clks[i].flags, base + clks[i].offset, clks[i].bit_idx, clks[i].gate_flags, clks[i].lock); if (IS_ERR(clk)) { pr_err("%s: failed to register clock %s\n", __func__, clks[i].name); continue; } if (clks[i].id) unit->clk_table[clks[i].id] = clk; } } void mmp_register_gate_clks(struct mmp_clk_unit *unit, struct mmp_param_gate_clk *clks, void __iomem *base, int size) { struct clk *clk; int i; for (i = 0; i < size; i++) { clk = mmp_clk_register_gate(NULL, clks[i].name, clks[i].parent_name, clks[i].flags, base + clks[i].offset, clks[i].mask, clks[i].val_enable, clks[i].val_disable, clks[i].gate_flags, clks[i].lock); if (IS_ERR(clk)) { pr_err("%s: failed to register clock %s\n", __func__, clks[i].name); continue; } if (clks[i].id) unit->clk_table[clks[i].id] = clk; } } void mmp_register_mux_clks(struct mmp_clk_unit *unit, struct mmp_param_mux_clk *clks, void __iomem *base, int size) { struct clk *clk; int i; for (i = 0; i < size; i++) { clk = clk_register_mux(NULL, clks[i].name, clks[i].parent_name, clks[i].num_parents, clks[i].flags, base + clks[i].offset, clks[i].shift, clks[i].width, clks[i].mux_flags, clks[i].lock); if (IS_ERR(clk)) { pr_err("%s: failed to register clock %s\n", __func__, clks[i].name); continue; } if (clks[i].id) unit->clk_table[clks[i].id] = clk; } } void mmp_register_div_clks(struct mmp_clk_unit *unit, struct mmp_param_div_clk *clks, void __iomem *base, int size) { struct clk *clk; int i; for (i = 0; i < size; i++) { clk = clk_register_divider(NULL, clks[i].name, clks[i].parent_name, clks[i].flags, base + clks[i].offset, clks[i].shift, clks[i].width, clks[i].div_flags, clks[i].lock); if (IS_ERR(clk)) { pr_err("%s: failed to register clock %s\n", __func__, clks[i].name); continue; } if (clks[i].id) unit->clk_table[clks[i].id] = clk; } } void mmp_clk_add(struct mmp_clk_unit *unit, unsigned int id, struct clk *clk) { if (IS_ERR_OR_NULL(clk)) { pr_err("CLK %d has invalid pointer %p\n", id, clk); return; } if (id >= unit->nr_clks) { pr_err("CLK %d is invalid\n", id); return; } unit->clk_table[id] = clk; } |