rk_cru_mux.c revision 1.1.2.2
1 1.1.2.2 pgoyette /* $NetBSD: rk_cru_mux.c,v 1.1.2.2 2018/06/25 07:25:39 pgoyette Exp $ */ 2 1.1.2.2 pgoyette 3 1.1.2.2 pgoyette /*- 4 1.1.2.2 pgoyette * Copyright (c) 2018 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: rk_cru_mux.c,v 1.1.2.2 2018/06/25 07:25:39 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/rockchip/rk_cru.h> 38 1.1.2.2 pgoyette 39 1.1.2.2 pgoyette const char * 40 1.1.2.2 pgoyette rk_cru_mux_get_parent(struct rk_cru_softc *sc, 41 1.1.2.2 pgoyette struct rk_cru_clk *clk) 42 1.1.2.2 pgoyette { 43 1.1.2.2 pgoyette struct rk_cru_mux *mux = &clk->u.mux; 44 1.1.2.2 pgoyette const bool mux_grf = (mux->flags & RK_MUX_GRF) != 0; 45 1.1.2.2 pgoyette 46 1.1.2.2 pgoyette KASSERT(clk->type == RK_CRU_MUX); 47 1.1.2.2 pgoyette 48 1.1.2.2 pgoyette if (mux_grf && !HAS_GRF(sc)) 49 1.1.2.2 pgoyette return NULL; 50 1.1.2.2 pgoyette 51 1.1.2.2 pgoyette const uint32_t val = mux_grf ? GRF_READ(sc, mux->reg) : CRU_READ(sc, mux->reg); 52 1.1.2.2 pgoyette const u_int index = __SHIFTOUT(val, mux->mask); 53 1.1.2.2 pgoyette 54 1.1.2.2 pgoyette return mux->parents[index]; 55 1.1.2.2 pgoyette } 56 1.1.2.2 pgoyette 57 1.1.2.2 pgoyette int 58 1.1.2.2 pgoyette rk_cru_mux_set_parent(struct rk_cru_softc *sc, 59 1.1.2.2 pgoyette struct rk_cru_clk *clk, const char *parent) 60 1.1.2.2 pgoyette { 61 1.1.2.2 pgoyette struct rk_cru_mux *mux = &clk->u.mux; 62 1.1.2.2 pgoyette const bool mux_grf = (mux->flags & RK_MUX_GRF) != 0; 63 1.1.2.2 pgoyette 64 1.1.2.2 pgoyette KASSERT(clk->type == RK_CRU_MUX); 65 1.1.2.2 pgoyette 66 1.1.2.2 pgoyette if (mux_grf && !HAS_GRF(sc)) 67 1.1.2.2 pgoyette return ENXIO; 68 1.1.2.2 pgoyette 69 1.1.2.2 pgoyette for (u_int index = 0; index < mux->nparents; index++) { 70 1.1.2.2 pgoyette if (strcmp(mux->parents[index], parent) == 0) { 71 1.1.2.2 pgoyette const uint32_t write_mask = mux->mask << 16; 72 1.1.2.2 pgoyette const uint32_t write_val = __SHIFTIN(index, mux->mask); 73 1.1.2.2 pgoyette 74 1.1.2.2 pgoyette if (mux_grf) 75 1.1.2.2 pgoyette GRF_WRITE(sc, mux->reg, write_mask | write_val); 76 1.1.2.2 pgoyette else 77 1.1.2.2 pgoyette CRU_WRITE(sc, mux->reg, write_mask | write_val); 78 1.1.2.2 pgoyette 79 1.1.2.2 pgoyette return 0; 80 1.1.2.2 pgoyette } 81 1.1.2.2 pgoyette } 82 1.1.2.2 pgoyette 83 1.1.2.2 pgoyette return EINVAL; 84 1.1.2.2 pgoyette } 85
Indexes created Fri Oct 17 23:09:53 GMT 2025