From d7dca11fbf4ab15ea00fffbec49195c9a39d7346 Mon Sep 17 00:00:00 2001
From: Rocco Marco Guglielmi <roccomarco.guglielmi@gmail.com>
Date: Sun, 17 Sep 2017 17:04:55 +0000
Subject: [PATCH] Added Matrix clock enable in SAMA/SAMA5D2x/hal_lld.c

git-svn-id: svn://svn.code.sf.net/p/chibios/svn/trunk@10619 35acf78f-673a-0410-8e92-d51de3d6d3f4
---
 os/hal/ports/SAMA/SAMA5D2x/hal_lld.c | 11 +++++++++++
 1 file changed, 11 insertions(+)

diff --git a/os/hal/ports/SAMA/SAMA5D2x/hal_lld.c b/os/hal/ports/SAMA/SAMA5D2x/hal_lld.c
index 9f780c3ec..c23de6eff 100644
--- a/os/hal/ports/SAMA/SAMA5D2x/hal_lld.c
+++ b/os/hal/ports/SAMA/SAMA5D2x/hal_lld.c
@@ -59,6 +59,17 @@
  * @notapi
  */
 void hal_lld_init(void) {
+
+  /* Disabling PMC write protection. */
+  pmcDisableWP();
+
+  /* Enabling matrix clock */
+  pmcEnableH32MX();
+  pmcEnableH64MX();
+
+  /* Enabling write protection.  */
+  pmcEnableWP();
+
 #if defined(SAMA_DMA_REQUIRED)
   dmaInit();
 #endif