1 files changed, 106 insertions, 0 deletions
diff --git a/cpukit/score/cpu/nios2/nios2-mpu-add-region.c b/cpukit/score/cpu/nios2/nios2-mpu-add-region.c
new file mode 100644
index 0000000000..d23769c48b
--- /dev/null
+++ b/cpukit/score/cpu/nios2/nios2-mpu-add-region.c
@@ -0,0 +1,106 @@
+/*
+ * Copyright (c) 2011 embedded brains GmbH.  All rights reserved.
+ *
+ *  embedded brains GmbH
+ *  Obere Lagerstr. 30
+ *  82178 Puchheim
+ *  Germany
+ *  <rtems@embedded-brains.de>
+ *
+ * The license and distribution terms for this file may be
+ * found in the file LICENSE in this distribution or at
+ * http://www.rtems.com/license/LICENSE.
+ */
+
+#ifdef HAVE_CONFIG_H
+  #include "config.h"
+#endif
+
+#include <rtems/score/nios2-utility.h>
+
+static bool _Nios2_MPU_Is_region_disabled(
+  const Nios2_MPU_Configuration *config,
+  uint32_t mpubase,
+  uint32_t mpuacc
+)
+{
+  bool disabled = false;
+
+  if ( config->region_uses_limit ) {
+    disabled = (mpubase & NIOS2_MPUBASE_BASE_MASK)
+      > (mpuacc & NIOS2_MPUACC_LIMIT_MASK);
+  } else {
+    disabled = (mpuacc & NIOS2_MPUACC_MASK_MASK) == 0;
+  }
+
+  return disabled;
+}
+
+int _Nios2_MPU_Get_disabled_region_index(
+  const Nios2_MPU_Configuration *config,
+  bool data,
+  int begin,
+  int end
+)
+{
+  int index = -1;
+  int count = _Nios2_MPU_Get_region_count( config, data );
+
+  if ( end < 0 || count < end ) {
+    end = count;
+  }
+
+  if ( begin >= 0 ) {
+    int i = 0;
+
+    for ( i = begin; i < end && index < 0; ++i ) {
+      uint32_t mpubase = 0;
+      uint32_t mpuacc = 0;
+
+      _Nios2_MPU_Get_region_registers( i, data, &mpubase, &mpuacc );
+
+      if ( _Nios2_MPU_Is_region_disabled( config, mpubase, mpuacc ) ) {
+        index = i;
+      }
+    }
+  }
+
+  return index;
+}
+
+bool _Nios2_MPU_Add_region(
+  const Nios2_MPU_Configuration *config,
+  const Nios2_MPU_Region_descriptor *desc,
+  bool force
+)
+{
+  bool ok = true;
+  int index = desc->index;
+  bool data = desc->data;
+  uint32_t mpubase = 0;
+  uint32_t mpuacc = 0;
+
+  if ( _Nios2_MPU_Is_valid_index( config, data, index ) ) {
+    if ( !force ) {
+      _Nios2_MPU_Get_region_registers( index, data, &mpubase, &mpuacc );
+      ok = _Nios2_MPU_Is_region_disabled( config, mpubase, mpuacc );
+    }
+
+    if ( ok ) {
+      ok = _Nios2_MPU_Setup_region_registers(
+        config,
+        desc,
+        &mpubase,
+        &mpuacc
+      );
+      if ( ok ) {
+        _Nios2_Set_ctlreg_mpubase(mpubase);
+        _Nios2_Set_ctlreg_mpuacc(mpuacc);
+      }
+    }
+  } else {
+    ok = false;
+  }
+
+  return ok;
+}