diff options
| -rw-r--r-- | drivers/clk/sunxi/Makefile | 1 | ||||
| -rw-r--r-- | drivers/clk/sunxi/clk-a10-hosc.c | 73 | ||||
| -rw-r--r-- | drivers/clk/sunxi/clk-sunxi.c | 57 |
3 files changed, 74 insertions, 57 deletions
diff --git a/drivers/clk/sunxi/Makefile b/drivers/clk/sunxi/Makefile index b5bac917612c..2c3d2fed2560 100644 --- a/drivers/clk/sunxi/Makefile +++ b/drivers/clk/sunxi/Makefile | |||
| @@ -3,3 +3,4 @@ | |||
| 3 | # | 3 | # |
| 4 | 4 | ||
| 5 | obj-y += clk-sunxi.o clk-factors.o | 5 | obj-y += clk-sunxi.o clk-factors.o |
| 6 | obj-y += clk-a10-hosc.o \ No newline at end of file | ||
diff --git a/drivers/clk/sunxi/clk-a10-hosc.c b/drivers/clk/sunxi/clk-a10-hosc.c new file mode 100644 index 000000000000..0481d5d673d6 --- /dev/null +++ b/drivers/clk/sunxi/clk-a10-hosc.c | |||
| @@ -0,0 +1,73 @@ | |||
| 1 | /* | ||
| 2 | * Copyright 2013 Emilio López | ||
| 3 | * | ||
| 4 | * Emilio López <emilio@elopez.com.ar> | ||
| 5 | * | ||
| 6 | * This program is free software; you can redistribute it and/or modify | ||
| 7 | * it under the terms of the GNU General Public License as published by | ||
| 8 | * the Free Software Foundation; either version 2 of the License, or | ||
| 9 | * (at your option) any later version. | ||
| 10 | * | ||
| 11 | * This program is distributed in the hope that it will be useful, | ||
| 12 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
| 13 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
| 14 | * GNU General Public License for more details. | ||
| 15 | */ | ||
| 16 | |||
| 17 | #include <linux/clk-provider.h> | ||
| 18 | #include <linux/clkdev.h> | ||
| 19 | #include <linux/of.h> | ||
| 20 | #include <linux/of_address.h> | ||
| 21 | |||
| 22 | #define SUNXI_OSC24M_GATE 0 | ||
| 23 | |||
| 24 | static DEFINE_SPINLOCK(hosc_lock); | ||
| 25 | |||
| 26 | static void __init sun4i_osc_clk_setup(struct device_node *node) | ||
| 27 | { | ||
| 28 | struct clk *clk; | ||
| 29 | struct clk_fixed_rate *fixed; | ||
| 30 | struct clk_gate *gate; | ||
| 31 | const char *clk_name = node->name; | ||
| 32 | u32 rate; | ||
| 33 | |||
| 34 | if (of_property_read_u32(node, "clock-frequency", &rate)) | ||
| 35 | return; | ||
| 36 | |||
| 37 | /* allocate fixed-rate and gate clock structs */ | ||
| 38 | fixed = kzalloc(sizeof(struct clk_fixed_rate), GFP_KERNEL); | ||
| 39 | if (!fixed) | ||
| 40 | return; | ||
| 41 | gate = kzalloc(sizeof(struct clk_gate), GFP_KERNEL); | ||
| 42 | if (!gate) | ||
| 43 | goto err_free_fixed; | ||
| 44 | |||
| 45 | of_property_read_string(node, "clock-output-names", &clk_name); | ||
| 46 | |||
| 47 | /* set up gate and fixed rate properties */ | ||
| 48 | gate->reg = of_iomap(node, 0); | ||
| 49 | gate->bit_idx = SUNXI_OSC24M_GATE; | ||
| 50 | gate->lock = &hosc_lock; | ||
| 51 | fixed->fixed_rate = rate; | ||
| 52 | |||
| 53 | clk = clk_register_composite(NULL, clk_name, | ||
| 54 | NULL, 0, | ||
| 55 | NULL, NULL, | ||
| 56 | &fixed->hw, &clk_fixed_rate_ops, | ||
| 57 | &gate->hw, &clk_gate_ops, | ||
| 58 | CLK_IS_ROOT); | ||
| 59 | |||
| 60 | if (IS_ERR(clk)) | ||
| 61 | goto err_free_gate; | ||
| 62 | |||
| 63 | of_clk_add_provider(node, of_clk_src_simple_get, clk); | ||
| 64 | clk_register_clkdev(clk, clk_name, NULL); | ||
| 65 | |||
| 66 | return; | ||
| 67 | |||
| 68 | err_free_gate: | ||
| 69 | kfree(gate); | ||
| 70 | err_free_fixed: | ||
| 71 | kfree(fixed); | ||
| 72 | } | ||
| 73 | CLK_OF_DECLARE(sun4i_osc, "allwinner,sun4i-a10-osc-clk", sun4i_osc_clk_setup); | ||
diff --git a/drivers/clk/sunxi/clk-sunxi.c b/drivers/clk/sunxi/clk-sunxi.c index 9bfa21ac04f4..4a8294dad613 100644 --- a/drivers/clk/sunxi/clk-sunxi.c +++ b/drivers/clk/sunxi/clk-sunxi.c | |||
| @@ -28,63 +28,6 @@ static DEFINE_SPINLOCK(clk_lock); | |||
| 28 | #define SUNXI_MAX_PARENTS 5 | 28 | #define SUNXI_MAX_PARENTS 5 |
| 29 | 29 | ||
| 30 | /** | 30 | /** |
| 31 | * sun4i_osc_clk_setup() - Setup function for gatable oscillator | ||
| 32 | */ | ||
| 33 | |||
| 34 | #define SUNXI_OSC24M_GATE 0 | ||
| 35 | |||
| 36 | static void __init sun4i_osc_clk_setup(struct device_node *node) | ||
| 37 | { | ||
| 38 | struct clk *clk; | ||
| 39 | struct clk_fixed_rate *fixed; | ||
| 40 | struct clk_gate *gate; | ||
| 41 | const char *clk_name = node->name; | ||
| 42 | u32 rate; | ||
| 43 | |||
| 44 | if (of_property_read_u32(node, "clock-frequency", &rate)) | ||
| 45 | return; | ||
| 46 | |||
| 47 | /* allocate fixed-rate and gate clock structs */ | ||
| 48 | fixed = kzalloc(sizeof(struct clk_fixed_rate), GFP_KERNEL); | ||
| 49 | if (!fixed) | ||
| 50 | return; | ||
| 51 | gate = kzalloc(sizeof(struct clk_gate), GFP_KERNEL); | ||
| 52 | if (!gate) | ||
| 53 | goto err_free_fixed; | ||
| 54 | |||
| 55 | of_property_read_string(node, "clock-output-names", &clk_name); | ||
| 56 | |||
| 57 | /* set up gate and fixed rate properties */ | ||
| 58 | gate->reg = of_iomap(node, 0); | ||
| 59 | gate->bit_idx = SUNXI_OSC24M_GATE; | ||
| 60 | gate->lock = &clk_lock; | ||
| 61 | fixed->fixed_rate = rate; | ||
| 62 | |||
| 63 | clk = clk_register_composite(NULL, clk_name, | ||
| 64 | NULL, 0, | ||
| 65 | NULL, NULL, | ||
| 66 | &fixed->hw, &clk_fixed_rate_ops, | ||
| 67 | &gate->hw, &clk_gate_ops, | ||
| 68 | CLK_IS_ROOT); | ||
| 69 | |||
| 70 | if (IS_ERR(clk)) | ||
| 71 | goto err_free_gate; | ||
| 72 | |||
| 73 | of_clk_add_provider(node, of_clk_src_simple_get, clk); | ||
| 74 | clk_register_clkdev(clk, clk_name, NULL); | ||
| 75 | |||
| 76 | return; | ||
| 77 | |||
| 78 | err_free_gate: | ||
| 79 | kfree(gate); | ||
| 80 | err_free_fixed: | ||
| 81 | kfree(fixed); | ||
| 82 | } | ||
| 83 | CLK_OF_DECLARE(sun4i_osc, "allwinner,sun4i-a10-osc-clk", sun4i_osc_clk_setup); | ||
| 84 | |||
| 85 | |||
| 86 | |||
| 87 | /** | ||
| 88 | * sun4i_get_pll1_factors() - calculates n, k, m, p factors for PLL1 | 31 | * sun4i_get_pll1_factors() - calculates n, k, m, p factors for PLL1 |
| 89 | * PLL1 rate is calculated as follows | 32 | * PLL1 rate is calculated as follows |
| 90 | * rate = (parent_rate * n * (k + 1) >> p) / (m + 1); | 33 | * rate = (parent_rate * n * (k + 1) >> p) / (m + 1); |
