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