1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * Copyright (c) 2018, The Linux Foundation. All rights reserved.
4 */
5
6 #include <linux/spinlock.h>
7 #include <asm/barrier.h>
8 #include <asm/sysreg.h>
9 #include <soc/qcom/kryo-l2-accessors.h>
10
11 #define L2CPUSRSELR_EL1 sys_reg(3, 3, 15, 0, 6)
12 #define L2CPUSRDR_EL1 sys_reg(3, 3, 15, 0, 7)
13
14 static DEFINE_RAW_SPINLOCK(l2_access_lock);
15
16 /**
17 * kryo_l2_set_indirect_reg() - write value to an L2 register
18 * @reg: Address of L2 register.
19 * @val: Value to be written to register.
20 *
21 * Use architecturally required barriers for ordering between system register
22 * accesses, and system registers with respect to device memory
23 */
kryo_l2_set_indirect_reg(u64 reg,u64 val)24 void kryo_l2_set_indirect_reg(u64 reg, u64 val)
25 {
26 unsigned long flags;
27
28 raw_spin_lock_irqsave(&l2_access_lock, flags);
29 write_sysreg_s(reg, L2CPUSRSELR_EL1);
30 isb();
31 write_sysreg_s(val, L2CPUSRDR_EL1);
32 isb();
33 raw_spin_unlock_irqrestore(&l2_access_lock, flags);
34 }
35 EXPORT_SYMBOL(kryo_l2_set_indirect_reg);
36
37 /**
38 * kryo_l2_get_indirect_reg() - read an L2 register value
39 * @reg: Address of L2 register.
40 *
41 * Use architecturally required barriers for ordering between system register
42 * accesses, and system registers with respect to device memory
43 */
kryo_l2_get_indirect_reg(u64 reg)44 u64 kryo_l2_get_indirect_reg(u64 reg)
45 {
46 u64 val;
47 unsigned long flags;
48
49 raw_spin_lock_irqsave(&l2_access_lock, flags);
50 write_sysreg_s(reg, L2CPUSRSELR_EL1);
51 isb();
52 val = read_sysreg_s(L2CPUSRDR_EL1);
53 raw_spin_unlock_irqrestore(&l2_access_lock, flags);
54
55 return val;
56 }
57 EXPORT_SYMBOL(kryo_l2_get_indirect_reg);
58