1 // SPDX-License-Identifier: GPL-2.0+ 2 /* 3 * Copyright (C) 2016 Freescale Semiconductor, Inc. 4 * Copyright 2017~2018 NXP 5 * 6 */ 7 8 #include <linux/clk-provider.h> 9 #include <linux/err.h> 10 #include <linux/slab.h> 11 12 #include "clk.h" 13 14 #define PCG_PCS_SHIFT 24 15 #define PCG_PCS_MASK 0x7 16 #define PCG_CGC_SHIFT 30 17 #define PCG_FRAC_SHIFT 3 18 #define PCG_FRAC_WIDTH 1 19 #define PCG_FRAC_MASK BIT(3) 20 #define PCG_PCD_SHIFT 0 21 #define PCG_PCD_WIDTH 3 22 #define PCG_PCD_MASK 0x7 23 24 struct clk_hw *imx7ulp_clk_composite(const char *name, 25 const char * const *parent_names, 26 int num_parents, bool mux_present, 27 bool rate_present, bool gate_present, 28 void __iomem *reg) 29 { 30 struct clk_hw *mux_hw = NULL, *fd_hw = NULL, *gate_hw = NULL; 31 struct clk_fractional_divider *fd = NULL; 32 struct clk_gate *gate = NULL; 33 struct clk_mux *mux = NULL; 34 struct clk_hw *hw; 35 36 if (mux_present) { 37 mux = kzalloc(sizeof(*mux), GFP_KERNEL); 38 if (!mux) 39 return ERR_PTR(-ENOMEM); 40 mux_hw = &mux->hw; 41 mux->reg = reg; 42 mux->shift = PCG_PCS_SHIFT; 43 mux->mask = PCG_PCS_MASK; 44 } 45 46 if (rate_present) { 47 fd = kzalloc(sizeof(*fd), GFP_KERNEL); 48 if (!fd) { 49 kfree(mux); 50 return ERR_PTR(-ENOMEM); 51 } 52 fd_hw = &fd->hw; 53 fd->reg = reg; 54 fd->mshift = PCG_FRAC_SHIFT; 55 fd->mwidth = PCG_FRAC_WIDTH; 56 fd->mmask = PCG_FRAC_MASK; 57 fd->nshift = PCG_PCD_SHIFT; 58 fd->nwidth = PCG_PCD_WIDTH; 59 fd->nmask = PCG_PCD_MASK; 60 fd->flags = CLK_FRAC_DIVIDER_ZERO_BASED; 61 } 62 63 if (gate_present) { 64 gate = kzalloc(sizeof(*gate), GFP_KERNEL); 65 if (!gate) { 66 kfree(mux); 67 kfree(fd); 68 return ERR_PTR(-ENOMEM); 69 } 70 gate_hw = &gate->hw; 71 gate->reg = reg; 72 gate->bit_idx = PCG_CGC_SHIFT; 73 } 74 75 hw = clk_hw_register_composite(NULL, name, parent_names, num_parents, 76 mux_hw, &clk_mux_ops, fd_hw, 77 &clk_fractional_divider_ops, gate_hw, 78 &clk_gate_ops, CLK_SET_RATE_GATE | 79 CLK_SET_PARENT_GATE); 80 if (IS_ERR(hw)) { 81 kfree(mux); 82 kfree(fd); 83 kfree(gate); 84 } 85 86 return hw; 87 } 88