Jorge Ramirez-Ortiz | bf084dc | 2018-09-23 09:36:13 +0200 | [diff] [blame] | 1 | /* |
Biju Das | 9a8f0ee | 2020-12-13 20:17:01 +0000 | [diff] [blame] | 2 | * Copyright (c) 2018-2020, Renesas Electronics Corporation. All rights reserved. |
Jorge Ramirez-Ortiz | bf084dc | 2018-09-23 09:36:13 +0200 | [diff] [blame] | 3 | * |
| 4 | * SPDX-License-Identifier: BSD-3-Clause |
| 5 | */ |
| 6 | |
Antonio Nino Diaz | e0f9063 | 2018-12-14 00:18:21 +0000 | [diff] [blame] | 7 | #include <lib/mmio.h> |
| 8 | |
Jorge Ramirez-Ortiz | bf084dc | 2018-09-23 09:36:13 +0200 | [diff] [blame] | 9 | #include "rcar_private.h" |
| 10 | |
Jorge Ramirez-Ortiz | bf084dc | 2018-09-23 09:36:13 +0200 | [diff] [blame] | 11 | #if IMAGE_BL31 |
Biju Das | 9a8f0ee | 2020-12-13 20:17:01 +0000 | [diff] [blame] | 12 | void __attribute__ ((section(".system_ram"))) cpg_write(uintptr_t regadr, uint32_t regval) |
| 13 | #else |
| 14 | void cpg_write(uintptr_t regadr, uint32_t regval) |
Jorge Ramirez-Ortiz | bf084dc | 2018-09-23 09:36:13 +0200 | [diff] [blame] | 15 | #endif |
Jorge Ramirez-Ortiz | bf084dc | 2018-09-23 09:36:13 +0200 | [diff] [blame] | 16 | { |
Biju Das | 9a8f0ee | 2020-12-13 20:17:01 +0000 | [diff] [blame] | 17 | uint32_t value = regval; |
| 18 | |
Jorge Ramirez-Ortiz | bf084dc | 2018-09-23 09:36:13 +0200 | [diff] [blame] | 19 | mmio_write_32((uintptr_t) RCAR_CPGWPR, ~value); |
| 20 | mmio_write_32(regadr, value); |
| 21 | } |
| 22 | |
Jorge Ramirez-Ortiz | bf084dc | 2018-09-23 09:36:13 +0200 | [diff] [blame] | 23 | #if IMAGE_BL31 |
Biju Das | 9a8f0ee | 2020-12-13 20:17:01 +0000 | [diff] [blame] | 24 | void __attribute__ ((section(".system_ram"))) mstpcr_write(uint32_t mstpcr, uint32_t mstpsr, |
| 25 | uint32_t target_bit) |
| 26 | #else |
| 27 | void mstpcr_write(uint32_t mstpcr, uint32_t mstpsr, uint32_t target_bit) |
Jorge Ramirez-Ortiz | bf084dc | 2018-09-23 09:36:13 +0200 | [diff] [blame] | 28 | #endif |
Jorge Ramirez-Ortiz | bf084dc | 2018-09-23 09:36:13 +0200 | [diff] [blame] | 29 | { |
| 30 | uint32_t reg; |
Biju Das | 9a8f0ee | 2020-12-13 20:17:01 +0000 | [diff] [blame] | 31 | |
Jorge Ramirez-Ortiz | bf084dc | 2018-09-23 09:36:13 +0200 | [diff] [blame] | 32 | reg = mmio_read_32(mstpcr); |
| 33 | reg &= ~target_bit; |
| 34 | cpg_write(mstpcr, reg); |
| 35 | while ((mmio_read_32(mstpsr) & target_bit) != 0U) { |
| 36 | } |
| 37 | } |