@@ -19,7 +19,9 @@
*/
#include <xen/config.h>
+#include <xen/delay.h>
#include <asm/platform.h>
+#include <asm/io.h>
#include <asm/gic.h>
static uint32_t xgene_storm_quirks(void)
@@ -107,6 +109,25 @@ err:
return ret;
}
+/*
+ * TODO: Get base address and mask from the device tree
+ */
+static void xgene_storm_reset(void)
+{
+ void __iomem *addr;
+
+ addr = ioremap_nocache(0x17000014UL, 0x100);
+
+ if ( !addr )
+ {
+ dprintk(XENLOG_ERR, "Unable to map xgene reset address\n");
+ return;
+ }
+
+ /* Write mask 0x1 to base address */
+ writel(0x1, addr);
+ mdelay(1000);
+}
static const char * const xgene_storm_dt_compat[] __initconst =
{
@@ -116,6 +137,7 @@ static const char * const xgene_storm_dt_compat[] __initconst =
PLATFORM_START(xgene_storm, "APM X-GENE STORM")
.compatible = xgene_storm_dt_compat,
+ .reset = xgene_storm_reset,
.quirks = xgene_storm_quirks,
.specific_mapping = xgene_storm_specific_mapping,