1 /* 2 * Copyright (c) 2018-2021, Renesas Electronics Corporation. All rights reserved. 3 * 4 * SPDX-License-Identifier: BSD-3-Clause 5 */ 6 7 #include <lib/mmio.h> 8 9 #include "cpg_registers.h" 10 #include "rcar_private.h" 11 12 #if IMAGE_BL31 13 void __attribute__ ((section(".system_ram"), no_stack_protector)) 14 cpg_write(uintptr_t regadr, uint32_t regval) 15 #else 16 void cpg_write(uintptr_t regadr, uint32_t regval) 17 #endif 18 { 19 uint32_t value = regval; 20 21 mmio_write_32(CPG_CPGWPR, ~value); 22 mmio_write_32(regadr, value); 23 } 24 25 #if IMAGE_BL31 26 void __attribute__ ((section(".system_ram"), no_stack_protector)) 27 mstpcr_write(uint32_t mstpcr, uint32_t mstpsr, uint32_t target_bit) 28 #else 29 void mstpcr_write(uint32_t mstpcr, uint32_t mstpsr, uint32_t target_bit) 30 #endif 31 { 32 uint32_t reg; 33 34 reg = mmio_read_32(mstpcr); 35 reg &= ~target_bit; 36 cpg_write(mstpcr, reg); 37 while ((mmio_read_32(mstpsr) & target_bit) != 0U) { 38 } 39 } 40