blob: 3916c048d541456b90662b062dc46dd560327a94 [file] [log] [blame]
Achin Gupta4f6ad662013-10-25 09:08:21 +01001/*
Dan Handleye83b0ca2014-01-14 18:17:09 +00002 * Copyright (c) 2013-2014, ARM Limited and Contributors. All rights reserved.
Achin Gupta4f6ad662013-10-25 09:08:21 +01003 *
4 * Redistribution and use in source and binary forms, with or without
5 * modification, are permitted provided that the following conditions are met:
6 *
7 * Redistributions of source code must retain the above copyright notice, this
8 * list of conditions and the following disclaimer.
9 *
10 * Redistributions in binary form must reproduce the above copyright notice,
11 * this list of conditions and the following disclaimer in the documentation
12 * and/or other materials provided with the distribution.
13 *
14 * Neither the name of ARM nor the names of its contributors may be used
15 * to endorse or promote products derived from this software without specific
16 * prior written permission.
17 *
18 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
19 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
20 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
21 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
22 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
23 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
24 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
25 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
26 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
27 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
28 * POSSIBILITY OF SUCH DAMAGE.
29 */
30
31#include <string.h>
32#include <stdio.h>
33#include <errno.h>
34#include <assert.h>
35#include <arch_helpers.h>
36#include <platform.h>
37#include <fvp_pwrc.h>
38#include <bakery_lock.h>
39
40/*
41 * TODO: Someday there will be a generic power controller api. At the moment
42 * each platform has its own pwrc so just exporting functions is fine.
43 */
44static bakery_lock pwrc_lock __attribute__ ((section("tzfw_coherent_mem")));
45
46unsigned int fvp_pwrc_get_cpu_wkr(unsigned long mpidr)
47{
48 unsigned int rc = 0;
49 bakery_lock_get(mpidr, &pwrc_lock);
50 mmio_write_32(PWRC_BASE + PSYSR_OFF, (unsigned int) mpidr);
51 rc = PSYSR_WK(mmio_read_32(PWRC_BASE + PSYSR_OFF));
52 bakery_lock_release(mpidr, &pwrc_lock);
53 return rc;
54}
55
56unsigned int fvp_pwrc_read_psysr(unsigned long mpidr)
57{
58 unsigned int rc = 0;
59 bakery_lock_get(mpidr, &pwrc_lock);
60 mmio_write_32(PWRC_BASE + PSYSR_OFF, (unsigned int) mpidr);
61 rc = mmio_read_32(PWRC_BASE + PSYSR_OFF);
62 bakery_lock_release(mpidr, &pwrc_lock);
63 return rc;
64}
65
66void fvp_pwrc_write_pponr(unsigned long mpidr)
67{
68 bakery_lock_get(mpidr, &pwrc_lock);
69 mmio_write_32(PWRC_BASE + PPONR_OFF, (unsigned int) mpidr);
70 bakery_lock_release(mpidr, &pwrc_lock);
71}
72
73void fvp_pwrc_write_ppoffr(unsigned long mpidr)
74{
75 bakery_lock_get(mpidr, &pwrc_lock);
76 mmio_write_32(PWRC_BASE + PPOFFR_OFF, (unsigned int) mpidr);
77 bakery_lock_release(mpidr, &pwrc_lock);
78}
79
Achin Guptab127cdb2013-11-12 16:40:00 +000080void fvp_pwrc_set_wen(unsigned long mpidr)
Achin Gupta4f6ad662013-10-25 09:08:21 +010081{
82 bakery_lock_get(mpidr, &pwrc_lock);
83 mmio_write_32(PWRC_BASE + PWKUPR_OFF,
84 (unsigned int) (PWKUPR_WEN | mpidr));
85 bakery_lock_release(mpidr, &pwrc_lock);
86}
87
Achin Guptab127cdb2013-11-12 16:40:00 +000088void fvp_pwrc_clr_wen(unsigned long mpidr)
89{
90 bakery_lock_get(mpidr, &pwrc_lock);
91 mmio_write_32(PWRC_BASE + PWKUPR_OFF,
92 (unsigned int) mpidr);
93 bakery_lock_release(mpidr, &pwrc_lock);
94}
95
Achin Gupta4f6ad662013-10-25 09:08:21 +010096void fvp_pwrc_write_pcoffr(unsigned long mpidr)
97{
98 bakery_lock_get(mpidr, &pwrc_lock);
99 mmio_write_32(PWRC_BASE + PCOFFR_OFF, (unsigned int) mpidr);
100 bakery_lock_release(mpidr, &pwrc_lock);
101}
102
103/* Nothing else to do here apart from initializing the lock */
104int fvp_pwrc_setup(void)
105{
106 bakery_lock_init(&pwrc_lock);
107 return 0;
108}
109
110
111