sunxi_ccu_div.c revision 1.4.2.2
1 1.4.2.2 jdolecek /* $NetBSD: sunxi_ccu_div.c,v 1.4.2.2 2017/12/03 11:35:56 jdolecek Exp $ */ 2 1.4.2.2 jdolecek 3 1.4.2.2 jdolecek /*- 4 1.4.2.2 jdolecek * Copyright (c) 2017 Jared McNeill <jmcneill (at) invisible.ca> 5 1.4.2.2 jdolecek * All rights reserved. 6 1.4.2.2 jdolecek * 7 1.4.2.2 jdolecek * Redistribution and use in source and binary forms, with or without 8 1.4.2.2 jdolecek * modification, are permitted provided that the following conditions 9 1.4.2.2 jdolecek * are met: 10 1.4.2.2 jdolecek * 1. Redistributions of source code must retain the above copyright 11 1.4.2.2 jdolecek * notice, this list of conditions and the following disclaimer. 12 1.4.2.2 jdolecek * 2. Redistributions in binary form must reproduce the above copyright 13 1.4.2.2 jdolecek * notice, this list of conditions and the following disclaimer in the 14 1.4.2.2 jdolecek * documentation and/or other materials provided with the distribution. 15 1.4.2.2 jdolecek * 16 1.4.2.2 jdolecek * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 17 1.4.2.2 jdolecek * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 18 1.4.2.2 jdolecek * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 19 1.4.2.2 jdolecek * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 20 1.4.2.2 jdolecek * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 21 1.4.2.2 jdolecek * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 22 1.4.2.2 jdolecek * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 23 1.4.2.2 jdolecek * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 24 1.4.2.2 jdolecek * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 25 1.4.2.2 jdolecek * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 26 1.4.2.2 jdolecek * SUCH DAMAGE. 27 1.4.2.2 jdolecek */ 28 1.4.2.2 jdolecek 29 1.4.2.2 jdolecek #include <sys/cdefs.h> 30 1.4.2.2 jdolecek __KERNEL_RCSID(0, "$NetBSD: sunxi_ccu_div.c,v 1.4.2.2 2017/12/03 11:35:56 jdolecek Exp $"); 31 1.4.2.2 jdolecek 32 1.4.2.2 jdolecek #include <sys/param.h> 33 1.4.2.2 jdolecek #include <sys/bus.h> 34 1.4.2.2 jdolecek 35 1.4.2.2 jdolecek #include <dev/clk/clk_backend.h> 36 1.4.2.2 jdolecek 37 1.4.2.2 jdolecek #include <arm/sunxi/sunxi_ccu.h> 38 1.4.2.2 jdolecek 39 1.4.2.2 jdolecek int 40 1.4.2.2 jdolecek sunxi_ccu_div_enable(struct sunxi_ccu_softc *sc, struct sunxi_ccu_clk *clk, 41 1.4.2.2 jdolecek int enable) 42 1.4.2.2 jdolecek { 43 1.4.2.2 jdolecek struct sunxi_ccu_div *div = &clk->u.div; 44 1.4.2.2 jdolecek uint32_t val; 45 1.4.2.2 jdolecek 46 1.4.2.2 jdolecek KASSERT(clk->type == SUNXI_CCU_DIV); 47 1.4.2.2 jdolecek 48 1.4.2.2 jdolecek if (!div->enable) 49 1.4.2.2 jdolecek return enable ? 0 : EINVAL; 50 1.4.2.2 jdolecek 51 1.4.2.2 jdolecek val = CCU_READ(sc, div->reg); 52 1.4.2.2 jdolecek if (enable) 53 1.4.2.2 jdolecek val |= div->enable; 54 1.4.2.2 jdolecek else 55 1.4.2.2 jdolecek val &= ~div->enable; 56 1.4.2.2 jdolecek CCU_WRITE(sc, div->reg, val); 57 1.4.2.2 jdolecek 58 1.4.2.2 jdolecek return 0; 59 1.4.2.2 jdolecek } 60 1.4.2.2 jdolecek 61 1.4.2.2 jdolecek u_int 62 1.4.2.2 jdolecek sunxi_ccu_div_get_rate(struct sunxi_ccu_softc *sc, 63 1.4.2.2 jdolecek struct sunxi_ccu_clk *clk) 64 1.4.2.2 jdolecek { 65 1.4.2.2 jdolecek struct sunxi_ccu_div *div = &clk->u.div; 66 1.4.2.2 jdolecek struct clk *clkp, *clkp_parent; 67 1.4.2.2 jdolecek u_int rate, ratio; 68 1.4.2.2 jdolecek uint32_t val; 69 1.4.2.2 jdolecek 70 1.4.2.2 jdolecek KASSERT(clk->type == SUNXI_CCU_DIV); 71 1.4.2.2 jdolecek 72 1.4.2.2 jdolecek clkp = &clk->base; 73 1.4.2.2 jdolecek clkp_parent = clk_get_parent(clkp); 74 1.4.2.2 jdolecek if (clkp_parent == NULL) 75 1.4.2.2 jdolecek return 0; 76 1.4.2.2 jdolecek 77 1.4.2.2 jdolecek rate = clk_get_rate(clkp_parent); 78 1.4.2.2 jdolecek if (rate == 0) 79 1.4.2.2 jdolecek return 0; 80 1.4.2.2 jdolecek 81 1.4.2.2 jdolecek val = CCU_READ(sc, div->reg); 82 1.4.2.2 jdolecek if (div->div) 83 1.4.2.2 jdolecek ratio = __SHIFTOUT(val, div->div); 84 1.4.2.2 jdolecek else 85 1.4.2.2 jdolecek ratio = 0; 86 1.4.2.2 jdolecek 87 1.4.2.2 jdolecek if ((div->flags & SUNXI_CCU_DIV_ZERO_IS_ONE) != 0 && ratio == 0) 88 1.4.2.2 jdolecek ratio = 1; 89 1.4.2.2 jdolecek if (div->flags & SUNXI_CCU_DIV_POWER_OF_TWO) 90 1.4.2.2 jdolecek ratio = 1 << ratio; 91 1.4.2.2 jdolecek else if (div->flags & SUNXI_CCU_DIV_TIMES_TWO) { 92 1.4.2.2 jdolecek ratio = ratio << 1; 93 1.4.2.2 jdolecek if (ratio == 0) 94 1.4.2.2 jdolecek ratio = 1; 95 1.4.2.2 jdolecek } else 96 1.4.2.2 jdolecek ratio++; 97 1.4.2.2 jdolecek 98 1.4.2.2 jdolecek return rate / ratio; 99 1.4.2.2 jdolecek } 100 1.4.2.2 jdolecek 101 1.4.2.2 jdolecek int 102 1.4.2.2 jdolecek sunxi_ccu_div_set_rate(struct sunxi_ccu_softc *sc, 103 1.4.2.2 jdolecek struct sunxi_ccu_clk *clk, u_int new_rate) 104 1.4.2.2 jdolecek { 105 1.4.2.2 jdolecek struct sunxi_ccu_div *div = &clk->u.div; 106 1.4.2.2 jdolecek struct clk *clkp, *clkp_parent; 107 1.4.2.2 jdolecek uint32_t val, raw_div; 108 1.4.2.2 jdolecek int ratio; 109 1.4.2.2 jdolecek 110 1.4.2.2 jdolecek KASSERT(clk->type == SUNXI_CCU_DIV); 111 1.4.2.2 jdolecek 112 1.4.2.2 jdolecek clkp = &clk->base; 113 1.4.2.2 jdolecek clkp_parent = clk_get_parent(clkp); 114 1.4.2.2 jdolecek if (clkp_parent == NULL) 115 1.4.2.2 jdolecek return ENXIO; 116 1.4.2.2 jdolecek 117 1.4.2.2 jdolecek if (div->div == 0) { 118 1.4.2.2 jdolecek if ((div->flags & SUNXI_CCU_DIV_SET_RATE_PARENT) != 0) 119 1.4.2.2 jdolecek return clk_set_rate(clkp_parent, new_rate); 120 1.4.2.2 jdolecek else 121 1.4.2.2 jdolecek return ENXIO; 122 1.4.2.2 jdolecek } 123 1.4.2.2 jdolecek 124 1.4.2.2 jdolecek val = CCU_READ(sc, div->reg); 125 1.4.2.2 jdolecek 126 1.4.2.2 jdolecek if ((div->flags & SUNXI_CCU_DIV_TIMES_TWO) != 0) { 127 1.4.2.2 jdolecek ratio = howmany(clk_get_rate(clkp_parent), new_rate); 128 1.4.2.2 jdolecek if (ratio > 1 && (ratio & 1) != 0) 129 1.4.2.2 jdolecek ratio++; 130 1.4.2.2 jdolecek raw_div = ratio >> 1; 131 1.4.2.2 jdolecek if (raw_div > __SHIFTOUT_MASK(div->div)) 132 1.4.2.2 jdolecek return ERANGE; 133 1.4.2.2 jdolecek } else { 134 1.4.2.2 jdolecek return EINVAL; 135 1.4.2.2 jdolecek } 136 1.4.2.2 jdolecek 137 1.4.2.2 jdolecek val &= ~div->div; 138 1.4.2.2 jdolecek val |= __SHIFTIN(raw_div, div->div); 139 1.4.2.2 jdolecek CCU_WRITE(sc, div->reg, val); 140 1.4.2.2 jdolecek 141 1.4.2.2 jdolecek return 0; 142 1.4.2.2 jdolecek } 143 1.4.2.2 jdolecek 144 1.4.2.2 jdolecek int 145 1.4.2.2 jdolecek sunxi_ccu_div_set_parent(struct sunxi_ccu_softc *sc, 146 1.4.2.2 jdolecek struct sunxi_ccu_clk *clk, const char *name) 147 1.4.2.2 jdolecek { 148 1.4.2.2 jdolecek struct sunxi_ccu_div *div = &clk->u.div; 149 1.4.2.2 jdolecek uint32_t val; 150 1.4.2.2 jdolecek u_int index; 151 1.4.2.2 jdolecek 152 1.4.2.2 jdolecek KASSERT(clk->type == SUNXI_CCU_DIV); 153 1.4.2.2 jdolecek 154 1.4.2.2 jdolecek if (div->sel == 0) 155 1.4.2.2 jdolecek return ENODEV; 156 1.4.2.2 jdolecek 157 1.4.2.2 jdolecek for (index = 0; index < div->nparents; index++) { 158 1.4.2.2 jdolecek if (div->parents[index] != NULL && 159 1.4.2.2 jdolecek strcmp(div->parents[index], name) == 0) 160 1.4.2.2 jdolecek break; 161 1.4.2.2 jdolecek } 162 1.4.2.2 jdolecek if (index == div->nparents) 163 1.4.2.2 jdolecek return EINVAL; 164 1.4.2.2 jdolecek 165 1.4.2.2 jdolecek val = CCU_READ(sc, div->reg); 166 1.4.2.2 jdolecek val &= ~div->sel; 167 1.4.2.2 jdolecek val |= __SHIFTIN(index, div->sel); 168 1.4.2.2 jdolecek CCU_WRITE(sc, div->reg, val); 169 1.4.2.2 jdolecek 170 1.4.2.2 jdolecek return 0; 171 1.4.2.2 jdolecek } 172 1.4.2.2 jdolecek 173 1.4.2.2 jdolecek const char * 174 1.4.2.2 jdolecek sunxi_ccu_div_get_parent(struct sunxi_ccu_softc *sc, 175 1.4.2.2 jdolecek struct sunxi_ccu_clk *clk) 176 1.4.2.2 jdolecek { 177 1.4.2.2 jdolecek struct sunxi_ccu_div *div = &clk->u.div; 178 1.4.2.2 jdolecek u_int index; 179 1.4.2.2 jdolecek uint32_t val; 180 1.4.2.2 jdolecek 181 1.4.2.2 jdolecek KASSERT(clk->type == SUNXI_CCU_DIV); 182 1.4.2.2 jdolecek 183 1.4.2.2 jdolecek if (div->sel == 0) 184 1.4.2.2 jdolecek return div->parents[0]; 185 1.4.2.2 jdolecek 186 1.4.2.2 jdolecek val = CCU_READ(sc, div->reg); 187 1.4.2.2 jdolecek index = __SHIFTOUT(val, div->sel); 188 1.4.2.2 jdolecek 189 1.4.2.2 jdolecek return div->parents[index]; 190 1.4.2.2 jdolecek } 191
Indexes created Sat Nov 01 21:09:44 GMT 2025