@@ -240,6 +240,7 @@ extern void gic_dist_enable(void);
extern bool gic_dist_disabled(void);
extern void gic_timer_retrigger(void);
extern void omap_smc1(u32 fn, u32 arg);
+extern void omap_smc1_2(u32 fn, u32 arg1, u32 arg2);
extern void __iomem *omap4_get_sar_ram_base(void);
extern void omap_do_wfi(void);
@@ -42,6 +42,7 @@
#define OMAP4_MON_L2X0_DBG_CTRL_INDEX 0x100
#define OMAP4_MON_L2X0_CTRL_INDEX 0x102
#define OMAP4_MON_L2X0_AUXCTRL_INDEX 0x109
+#define OMAP4_MON_L2X0_SETLATENCY_INDEX 0x112
#define OMAP4_MON_L2X0_PREFETCH_INDEX 0x113
#define OMAP5_DRA7_MON_SET_CNTFRQ_INDEX 0x109
@@ -33,6 +33,26 @@ ENTRY(omap_smc1)
ldmfd sp!, {r2-r12, pc}
ENDPROC(omap_smc1)
+/*
+ * This is common routine to manage secure monitor API
+ * used to modify the PL310 secure registers.
+ * 'r0' and 'r1' contains the value to be modified and 'r12' contains
+ * the monitor API number. It uses few CPU registers
+ * internally and hence they need be backed up including
+ * link register "lr".
+ * Function signature : void omap_smc1_2(u32 fn, u32 arg1, u32 arg2)
+ */
+
+ENTRY(omap_smc1_2)
+ stmfd sp!, {r2-r12, lr}
+ mov r12, r0
+ mov r0, r1
+ mov r1, r2
+ dsb
+ smc #0
+ ldmfd sp!, {r2-r12, pc}
+ENDPROC(omap_smc1_2)
+
/**
* u32 omap_smc2(u32 id, u32 falg, u32 pargs)
* Low level common routine for secure HAL and PPA APIs.
@@ -191,6 +191,21 @@ void omap4_l2c310_write_sec(unsigned long val, unsigned reg)
pr_info_once("OMAP L2C310: ROM does not support power control setting\n");
return;
+ case L310_TAG_LATENCY_CTRL:
+ case L310_DATA_LATENCY_CTRL:
+ {
+ void __iomem *base = omap4_get_l2cache_base();
+ u32 data_latency, tag_latency;
+
+ tag_latency = (reg == L310_TAG_LATENCY_CTRL) ? val :
+ readl_relaxed(base + L310_TAG_LATENCY_CTRL);
+ data_latency = (reg == L310_DATA_LATENCY_CTRL) ? val :
+ readl_relaxed(base + L310_DATA_LATENCY_CTRL);
+ omap_smc1_2(OMAP4_MON_L2X0_SETLATENCY_INDEX, tag_latency,
+ data_latency);
+ return;
+ }
+
default:
WARN_ONCE(1, "OMAP L2C310: ignoring write to reg 0x%x\n", reg);
return;
OMAP4 and AM437x generations of processors support programming the PL310 L2Cache controller's Latency control registers using a secure montior call. Unfortunately, this varies from other PL310 programming sequence with a requirement of two parameters instead of the generic single parameter configuration. Information based on: OMAP4430 Public ROM Code API Functional Specfication revision 0.6 (Oct 27, 2010) OMAP4440 Public ROM Code API Functional Specfication revision 0.1 (Oct 27, 2010) Aegis ROM Code Memory and Peripheral Booting Functional Specification version 1.00 (Jan 1, 2014) Signed-off-by: Nishanth Menon <nm@ti.com> --- arch/arm/mach-omap2/common.h | 1 + arch/arm/mach-omap2/omap-secure.h | 1 + arch/arm/mach-omap2/omap-smc.S | 20 ++++++++++++++++++++ arch/arm/mach-omap2/omap4-common.c | 15 +++++++++++++++ 4 files changed, 37 insertions(+)