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