meson_clk_mpll.c revision 1.1.2.2
1 1.1.2.2 pgoyette /* $NetBSD: meson_clk_mpll.c,v 1.1.2.2 2019/01/26 21:59:59 pgoyette Exp $ */ 2 1.1.2.2 pgoyette 3 1.1.2.2 pgoyette /*- 4 1.1.2.2 pgoyette * Copyright (c) 2019 Jared McNeill <jmcneill (at) invisible.ca> 5 1.1.2.2 pgoyette * All rights reserved. 6 1.1.2.2 pgoyette * 7 1.1.2.2 pgoyette * Redistribution and use in source and binary forms, with or without 8 1.1.2.2 pgoyette * modification, are permitted provided that the following conditions 9 1.1.2.2 pgoyette * are met: 10 1.1.2.2 pgoyette * 1. Redistributions of source code must retain the above copyright 11 1.1.2.2 pgoyette * notice, this list of conditions and the following disclaimer. 12 1.1.2.2 pgoyette * 2. Redistributions in binary form must reproduce the above copyright 13 1.1.2.2 pgoyette * notice, this list of conditions and the following disclaimer in the 14 1.1.2.2 pgoyette * documentation and/or other materials provided with the distribution. 15 1.1.2.2 pgoyette * 16 1.1.2.2 pgoyette * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 17 1.1.2.2 pgoyette * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 18 1.1.2.2 pgoyette * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 19 1.1.2.2 pgoyette * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 20 1.1.2.2 pgoyette * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 21 1.1.2.2 pgoyette * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 22 1.1.2.2 pgoyette * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 23 1.1.2.2 pgoyette * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 24 1.1.2.2 pgoyette * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 25 1.1.2.2 pgoyette * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 26 1.1.2.2 pgoyette * SUCH DAMAGE. 27 1.1.2.2 pgoyette */ 28 1.1.2.2 pgoyette 29 1.1.2.2 pgoyette #include <sys/cdefs.h> 30 1.1.2.2 pgoyette __KERNEL_RCSID(0, "$NetBSD: meson_clk_mpll.c,v 1.1.2.2 2019/01/26 21:59:59 pgoyette Exp $"); 31 1.1.2.2 pgoyette 32 1.1.2.2 pgoyette #include <sys/param.h> 33 1.1.2.2 pgoyette #include <sys/bus.h> 34 1.1.2.2 pgoyette 35 1.1.2.2 pgoyette #include <dev/clk/clk_backend.h> 36 1.1.2.2 pgoyette 37 1.1.2.2 pgoyette #include <arm/amlogic/meson_clk.h> 38 1.1.2.2 pgoyette 39 1.1.2.2 pgoyette #define SDM_DEN 0x4000 40 1.1.2.2 pgoyette 41 1.1.2.2 pgoyette u_int 42 1.1.2.2 pgoyette meson_clk_mpll_get_rate(struct meson_clk_softc *sc, 43 1.1.2.2 pgoyette struct meson_clk_clk *clk) 44 1.1.2.2 pgoyette { 45 1.1.2.2 pgoyette struct meson_clk_mpll *mpll = &clk->u.mpll; 46 1.1.2.2 pgoyette struct clk *clkp, *clkp_parent; 47 1.1.2.2 pgoyette uint64_t parent_rate, sdm, n2; 48 1.1.2.2 pgoyette uint32_t val; 49 1.1.2.2 pgoyette 50 1.1.2.2 pgoyette KASSERT(clk->type == MESON_CLK_MPLL); 51 1.1.2.2 pgoyette 52 1.1.2.2 pgoyette clkp = &clk->base; 53 1.1.2.2 pgoyette clkp_parent = clk_get_parent(clkp); 54 1.1.2.2 pgoyette if (clkp_parent == NULL) 55 1.1.2.2 pgoyette return 0; 56 1.1.2.2 pgoyette 57 1.1.2.2 pgoyette parent_rate = clk_get_rate(clkp_parent); 58 1.1.2.2 pgoyette if (parent_rate == 0) 59 1.1.2.2 pgoyette return 0; 60 1.1.2.2 pgoyette 61 1.1.2.2 pgoyette val = CLK_READ(sc, mpll->sdm.reg); 62 1.1.2.2 pgoyette sdm = __SHIFTOUT(val, mpll->sdm.mask); 63 1.1.2.2 pgoyette 64 1.1.2.2 pgoyette val = CLK_READ(sc, mpll->n2.reg); 65 1.1.2.2 pgoyette n2 = __SHIFTOUT(val, mpll->n2.mask); 66 1.1.2.2 pgoyette 67 1.1.2.2 pgoyette const uint64_t div = (SDM_DEN * n2) + sdm; 68 1.1.2.2 pgoyette if (div == 0) 69 1.1.2.2 pgoyette return 0; 70 1.1.2.2 pgoyette 71 1.1.2.2 pgoyette return (u_int)howmany(parent_rate * SDM_DEN, div); 72 1.1.2.2 pgoyette } 73 1.1.2.2 pgoyette 74 1.1.2.2 pgoyette const char * 75 1.1.2.2 pgoyette meson_clk_mpll_get_parent(struct meson_clk_softc *sc, 76 1.1.2.2 pgoyette struct meson_clk_clk *clk) 77 1.1.2.2 pgoyette { 78 1.1.2.2 pgoyette struct meson_clk_mpll *mpll = &clk->u.mpll; 79 1.1.2.2 pgoyette 80 1.1.2.2 pgoyette KASSERT(clk->type == MESON_CLK_MPLL); 81 1.1.2.2 pgoyette 82 1.1.2.2 pgoyette return mpll->parent; 83 1.1.2.2 pgoyette } 84
Indexes created Mon Sep 29 21:09:56 GMT 2025