Soren Brinkmann | 76fcae3 | 2016-03-06 20:16:27 -0800 | [diff] [blame] | 1 | /* |
Wendy Liang | 328105c | 2017-10-03 23:21:11 -0700 | [diff] [blame] | 2 | * Copyright (c) 2013-2017, ARM Limited and Contributors. All rights reserved. |
Soren Brinkmann | 76fcae3 | 2016-03-06 20:16:27 -0800 | [diff] [blame] | 3 | * |
dp-arm | fa3cf0b | 2017-05-03 09:38:09 +0100 | [diff] [blame] | 4 | * SPDX-License-Identifier: BSD-3-Clause |
Soren Brinkmann | 76fcae3 | 2016-03-06 20:16:27 -0800 | [diff] [blame] | 5 | */ |
| 6 | |
Isla Mitchell | e363146 | 2017-07-14 10:46:32 +0100 | [diff] [blame] | 7 | #include <arch_helpers.h> |
Antonio Nino Diaz | e0f9063 | 2018-12-14 00:18:21 +0000 | [diff] [blame] | 8 | #include <lib/bakery_lock.h> |
| 9 | #include <lib/mmio.h> |
| 10 | #include <plat/common/platform.h> |
| 11 | |
Wendy Liang | 328105c | 2017-10-03 23:21:11 -0700 | [diff] [blame] | 12 | #include "../zynqmp_ipi.h" |
Soren Brinkmann | 76fcae3 | 2016-03-06 20:16:27 -0800 | [diff] [blame] | 13 | #include "../zynqmp_private.h" |
Isla Mitchell | e363146 | 2017-07-14 10:46:32 +0100 | [diff] [blame] | 14 | #include "pm_ipi.h" |
Soren Brinkmann | 76fcae3 | 2016-03-06 20:16:27 -0800 | [diff] [blame] | 15 | |
| 16 | /* IPI message buffers */ |
| 17 | #define IPI_BUFFER_BASEADDR 0xFF990000U |
| 18 | |
Soren Brinkmann | 76fcae3 | 2016-03-06 20:16:27 -0800 | [diff] [blame] | 19 | #define IPI_BUFFER_APU_BASE (IPI_BUFFER_BASEADDR + 0x400U) |
Soren Brinkmann | 76fcae3 | 2016-03-06 20:16:27 -0800 | [diff] [blame] | 20 | #define IPI_BUFFER_PMU_BASE (IPI_BUFFER_BASEADDR + 0xE00U) |
| 21 | |
Soren Brinkmann | 76fcae3 | 2016-03-06 20:16:27 -0800 | [diff] [blame] | 22 | #define IPI_BUFFER_TARGET_APU_OFFSET 0x80U |
Soren Brinkmann | 76fcae3 | 2016-03-06 20:16:27 -0800 | [diff] [blame] | 23 | #define IPI_BUFFER_TARGET_PMU_OFFSET 0x1C0U |
| 24 | |
Soren Brinkmann | 84f0af4 | 2016-09-30 14:24:25 -0700 | [diff] [blame] | 25 | #define IPI_BUFFER_MAX_WORDS 8 |
| 26 | |
Soren Brinkmann | 76fcae3 | 2016-03-06 20:16:27 -0800 | [diff] [blame] | 27 | #define IPI_BUFFER_REQ_OFFSET 0x0U |
| 28 | #define IPI_BUFFER_RESP_OFFSET 0x20U |
| 29 | |
Tejas Patel | af4b10e | 2018-02-09 02:42:59 -0800 | [diff] [blame] | 30 | #define IPI_BLOCKING 1 |
| 31 | #define IPI_NON_BLOCKING 0 |
| 32 | |
Stefan Krsmanovic | c5e9f66 | 2016-05-20 15:51:08 +0200 | [diff] [blame] | 33 | DEFINE_BAKERY_LOCK(pm_secure_lock); |
Soren Brinkmann | 76fcae3 | 2016-03-06 20:16:27 -0800 | [diff] [blame] | 34 | |
| 35 | const struct pm_ipi apu_ipi = { |
Wendy Liang | 328105c | 2017-10-03 23:21:11 -0700 | [diff] [blame] | 36 | .apu_ipi_id = IPI_ID_APU, |
| 37 | .pmu_ipi_id = IPI_ID_PMU0, |
Soren Brinkmann | 76fcae3 | 2016-03-06 20:16:27 -0800 | [diff] [blame] | 38 | .buffer_base = IPI_BUFFER_APU_BASE, |
| 39 | }; |
| 40 | |
| 41 | /** |
| 42 | * pm_ipi_init() - Initialize IPI peripheral for communication with PMU |
| 43 | * |
Wendy Liang | 328105c | 2017-10-03 23:21:11 -0700 | [diff] [blame] | 44 | * @proc Pointer to the processor who is initiating request |
Soren Brinkmann | 76fcae3 | 2016-03-06 20:16:27 -0800 | [diff] [blame] | 45 | * @return On success, the initialization function must return 0. |
| 46 | * Any other return value will cause the framework to ignore |
| 47 | * the service |
| 48 | * |
Soren Brinkmann | 76fcae3 | 2016-03-06 20:16:27 -0800 | [diff] [blame] | 49 | * Called from pm_setup initialization function |
| 50 | */ |
Wendy Liang | 328105c | 2017-10-03 23:21:11 -0700 | [diff] [blame] | 51 | int pm_ipi_init(const struct pm_proc *proc) |
Soren Brinkmann | 76fcae3 | 2016-03-06 20:16:27 -0800 | [diff] [blame] | 52 | { |
| 53 | bakery_lock_init(&pm_secure_lock); |
Wendy Liang | 328105c | 2017-10-03 23:21:11 -0700 | [diff] [blame] | 54 | ipi_mb_open(proc->ipi->apu_ipi_id, proc->ipi->pmu_ipi_id); |
Soren Brinkmann | 76fcae3 | 2016-03-06 20:16:27 -0800 | [diff] [blame] | 55 | |
| 56 | return 0; |
| 57 | } |
| 58 | |
| 59 | /** |
Soren Brinkmann | 76fcae3 | 2016-03-06 20:16:27 -0800 | [diff] [blame] | 60 | * pm_ipi_send_common() - Sends IPI request to the PMU |
| 61 | * @proc Pointer to the processor who is initiating request |
| 62 | * @payload API id and call arguments to be written in IPI buffer |
| 63 | * |
| 64 | * Send an IPI request to the power controller. Caller needs to hold |
| 65 | * the 'pm_secure_lock' lock. |
| 66 | * |
| 67 | * @return Returns status, either success or error+reason |
| 68 | */ |
| 69 | static enum pm_ret_status pm_ipi_send_common(const struct pm_proc *proc, |
Tejas Patel | af4b10e | 2018-02-09 02:42:59 -0800 | [diff] [blame] | 70 | uint32_t payload[PAYLOAD_ARG_CNT], |
| 71 | uint32_t is_blocking) |
Soren Brinkmann | 76fcae3 | 2016-03-06 20:16:27 -0800 | [diff] [blame] | 72 | { |
| 73 | unsigned int offset = 0; |
| 74 | uintptr_t buffer_base = proc->ipi->buffer_base + |
| 75 | IPI_BUFFER_TARGET_PMU_OFFSET + |
| 76 | IPI_BUFFER_REQ_OFFSET; |
| 77 | |
Soren Brinkmann | 76fcae3 | 2016-03-06 20:16:27 -0800 | [diff] [blame] | 78 | /* Write payload into IPI buffer */ |
| 79 | for (size_t i = 0; i < PAYLOAD_ARG_CNT; i++) { |
| 80 | mmio_write_32(buffer_base + offset, payload[i]); |
| 81 | offset += PAYLOAD_ARG_SIZE; |
| 82 | } |
Tejas Patel | af4b10e | 2018-02-09 02:42:59 -0800 | [diff] [blame] | 83 | |
Soren Brinkmann | 76fcae3 | 2016-03-06 20:16:27 -0800 | [diff] [blame] | 84 | /* Generate IPI to PMU */ |
Tejas Patel | af4b10e | 2018-02-09 02:42:59 -0800 | [diff] [blame] | 85 | ipi_mb_notify(proc->ipi->apu_ipi_id, proc->ipi->pmu_ipi_id, |
| 86 | is_blocking); |
Soren Brinkmann | 76fcae3 | 2016-03-06 20:16:27 -0800 | [diff] [blame] | 87 | |
| 88 | return PM_RET_SUCCESS; |
| 89 | } |
| 90 | |
| 91 | /** |
Tejas Patel | af4b10e | 2018-02-09 02:42:59 -0800 | [diff] [blame] | 92 | * pm_ipi_send_non_blocking() - Sends IPI request to the PMU without blocking |
| 93 | * notification |
| 94 | * @proc Pointer to the processor who is initiating request |
| 95 | * @payload API id and call arguments to be written in IPI buffer |
| 96 | * |
| 97 | * Send an IPI request to the power controller. |
| 98 | * |
| 99 | * @return Returns status, either success or error+reason |
| 100 | */ |
| 101 | enum pm_ret_status pm_ipi_send_non_blocking(const struct pm_proc *proc, |
| 102 | uint32_t payload[PAYLOAD_ARG_CNT]) |
| 103 | { |
| 104 | enum pm_ret_status ret; |
| 105 | |
| 106 | bakery_lock_get(&pm_secure_lock); |
| 107 | |
| 108 | ret = pm_ipi_send_common(proc, payload, IPI_NON_BLOCKING); |
| 109 | |
| 110 | bakery_lock_release(&pm_secure_lock); |
| 111 | |
| 112 | return ret; |
| 113 | } |
| 114 | |
| 115 | /** |
Soren Brinkmann | 76fcae3 | 2016-03-06 20:16:27 -0800 | [diff] [blame] | 116 | * pm_ipi_send() - Sends IPI request to the PMU |
| 117 | * @proc Pointer to the processor who is initiating request |
| 118 | * @payload API id and call arguments to be written in IPI buffer |
| 119 | * |
| 120 | * Send an IPI request to the power controller. |
| 121 | * |
| 122 | * @return Returns status, either success or error+reason |
| 123 | */ |
| 124 | enum pm_ret_status pm_ipi_send(const struct pm_proc *proc, |
| 125 | uint32_t payload[PAYLOAD_ARG_CNT]) |
| 126 | { |
| 127 | enum pm_ret_status ret; |
| 128 | |
| 129 | bakery_lock_get(&pm_secure_lock); |
| 130 | |
Tejas Patel | af4b10e | 2018-02-09 02:42:59 -0800 | [diff] [blame] | 131 | ret = pm_ipi_send_common(proc, payload, IPI_BLOCKING); |
Soren Brinkmann | 76fcae3 | 2016-03-06 20:16:27 -0800 | [diff] [blame] | 132 | |
| 133 | bakery_lock_release(&pm_secure_lock); |
| 134 | |
| 135 | return ret; |
| 136 | } |
| 137 | |
| 138 | |
| 139 | /** |
| 140 | * pm_ipi_buff_read() - Reads IPI response after PMU has handled interrupt |
| 141 | * @proc Pointer to the processor who is waiting and reading response |
Soren Brinkmann | d6c9e03 | 2016-09-22 11:35:47 -0700 | [diff] [blame] | 142 | * @value Used to return value from IPI buffer element (optional) |
| 143 | * @count Number of values to return in @value |
Soren Brinkmann | 76fcae3 | 2016-03-06 20:16:27 -0800 | [diff] [blame] | 144 | * |
| 145 | * @return Returns status, either success or error+reason |
| 146 | */ |
| 147 | static enum pm_ret_status pm_ipi_buff_read(const struct pm_proc *proc, |
Soren Brinkmann | d6c9e03 | 2016-09-22 11:35:47 -0700 | [diff] [blame] | 148 | unsigned int *value, size_t count) |
Soren Brinkmann | 76fcae3 | 2016-03-06 20:16:27 -0800 | [diff] [blame] | 149 | { |
Soren Brinkmann | d6c9e03 | 2016-09-22 11:35:47 -0700 | [diff] [blame] | 150 | size_t i; |
Soren Brinkmann | 76fcae3 | 2016-03-06 20:16:27 -0800 | [diff] [blame] | 151 | uintptr_t buffer_base = proc->ipi->buffer_base + |
| 152 | IPI_BUFFER_TARGET_PMU_OFFSET + |
| 153 | IPI_BUFFER_RESP_OFFSET; |
| 154 | |
Soren Brinkmann | 76fcae3 | 2016-03-06 20:16:27 -0800 | [diff] [blame] | 155 | /* |
| 156 | * Read response from IPI buffer |
| 157 | * buf-0: success or error+reason |
| 158 | * buf-1: value |
| 159 | * buf-2: unused |
| 160 | * buf-3: unused |
| 161 | */ |
Soren Brinkmann | d6c9e03 | 2016-09-22 11:35:47 -0700 | [diff] [blame] | 162 | for (i = 1; i <= count; i++) { |
| 163 | *value = mmio_read_32(buffer_base + (i * PAYLOAD_ARG_SIZE)); |
| 164 | value++; |
| 165 | } |
Soren Brinkmann | 76fcae3 | 2016-03-06 20:16:27 -0800 | [diff] [blame] | 166 | |
| 167 | return mmio_read_32(buffer_base); |
| 168 | } |
| 169 | |
| 170 | /** |
Soren Brinkmann | 84f0af4 | 2016-09-30 14:24:25 -0700 | [diff] [blame] | 171 | * pm_ipi_buff_read_callb() - Reads IPI response after PMU has handled interrupt |
| 172 | * @value Used to return value from IPI buffer element (optional) |
| 173 | * @count Number of values to return in @value |
| 174 | * |
| 175 | * @return Returns status, either success or error+reason |
| 176 | */ |
| 177 | void pm_ipi_buff_read_callb(unsigned int *value, size_t count) |
| 178 | { |
| 179 | size_t i; |
| 180 | uintptr_t buffer_base = IPI_BUFFER_PMU_BASE + |
| 181 | IPI_BUFFER_TARGET_APU_OFFSET + |
| 182 | IPI_BUFFER_REQ_OFFSET; |
| 183 | |
| 184 | if (count > IPI_BUFFER_MAX_WORDS) |
| 185 | count = IPI_BUFFER_MAX_WORDS; |
| 186 | |
| 187 | for (i = 0; i <= count; i++) { |
| 188 | *value = mmio_read_32(buffer_base + (i * PAYLOAD_ARG_SIZE)); |
| 189 | value++; |
| 190 | } |
| 191 | } |
| 192 | |
| 193 | /** |
Soren Brinkmann | 76fcae3 | 2016-03-06 20:16:27 -0800 | [diff] [blame] | 194 | * pm_ipi_send_sync() - Sends IPI request to the PMU |
| 195 | * @proc Pointer to the processor who is initiating request |
| 196 | * @payload API id and call arguments to be written in IPI buffer |
Soren Brinkmann | d6c9e03 | 2016-09-22 11:35:47 -0700 | [diff] [blame] | 197 | * @value Used to return value from IPI buffer element (optional) |
| 198 | * @count Number of values to return in @value |
Soren Brinkmann | 76fcae3 | 2016-03-06 20:16:27 -0800 | [diff] [blame] | 199 | * |
| 200 | * Send an IPI request to the power controller and wait for it to be handled. |
| 201 | * |
| 202 | * @return Returns status, either success or error+reason and, optionally, |
| 203 | * @value |
| 204 | */ |
| 205 | enum pm_ret_status pm_ipi_send_sync(const struct pm_proc *proc, |
| 206 | uint32_t payload[PAYLOAD_ARG_CNT], |
Soren Brinkmann | d6c9e03 | 2016-09-22 11:35:47 -0700 | [diff] [blame] | 207 | unsigned int *value, size_t count) |
Soren Brinkmann | 76fcae3 | 2016-03-06 20:16:27 -0800 | [diff] [blame] | 208 | { |
| 209 | enum pm_ret_status ret; |
| 210 | |
| 211 | bakery_lock_get(&pm_secure_lock); |
| 212 | |
Tejas Patel | af4b10e | 2018-02-09 02:42:59 -0800 | [diff] [blame] | 213 | ret = pm_ipi_send_common(proc, payload, IPI_BLOCKING); |
Soren Brinkmann | 76fcae3 | 2016-03-06 20:16:27 -0800 | [diff] [blame] | 214 | if (ret != PM_RET_SUCCESS) |
| 215 | goto unlock; |
| 216 | |
Soren Brinkmann | d6c9e03 | 2016-09-22 11:35:47 -0700 | [diff] [blame] | 217 | ret = pm_ipi_buff_read(proc, value, count); |
Soren Brinkmann | 76fcae3 | 2016-03-06 20:16:27 -0800 | [diff] [blame] | 218 | |
| 219 | unlock: |
| 220 | bakery_lock_release(&pm_secure_lock); |
| 221 | |
| 222 | return ret; |
| 223 | } |
Soren Brinkmann | a1b0a90 | 2016-09-30 11:30:21 -0700 | [diff] [blame] | 224 | |
Wendy Liang | 328105c | 2017-10-03 23:21:11 -0700 | [diff] [blame] | 225 | void pm_ipi_irq_enable(const struct pm_proc *proc) |
Soren Brinkmann | a1b0a90 | 2016-09-30 11:30:21 -0700 | [diff] [blame] | 226 | { |
Wendy Liang | 328105c | 2017-10-03 23:21:11 -0700 | [diff] [blame] | 227 | ipi_mb_enable_irq(proc->ipi->apu_ipi_id, proc->ipi->pmu_ipi_id); |
Soren Brinkmann | a1b0a90 | 2016-09-30 11:30:21 -0700 | [diff] [blame] | 228 | } |
Soren Brinkmann | 84f0af4 | 2016-09-30 14:24:25 -0700 | [diff] [blame] | 229 | |
Wendy Liang | 328105c | 2017-10-03 23:21:11 -0700 | [diff] [blame] | 230 | void pm_ipi_irq_clear(const struct pm_proc *proc) |
Soren Brinkmann | 84f0af4 | 2016-09-30 14:24:25 -0700 | [diff] [blame] | 231 | { |
Wendy Liang | 328105c | 2017-10-03 23:21:11 -0700 | [diff] [blame] | 232 | ipi_mb_ack(proc->ipi->apu_ipi_id, proc->ipi->pmu_ipi_id); |
Soren Brinkmann | 84f0af4 | 2016-09-30 14:24:25 -0700 | [diff] [blame] | 233 | } |