From 8671786934eab0d2894809014f99c005f2c8d22a Mon Sep 17 00:00:00 2001
From: Pavel Pisa <pisa@cmp.felk.cvut.cz>
Date: Thu, 22 Sep 2016 09:50:59 +0200
Subject: arm/tms570: include hardware initialization and selftest based on Ti
 HalCoGen generated files.

The configuration is specific for TMS570LS3137 based HDK.
Pins configuration can be easily changed in

  rtems/c/src/lib/libbsp/arm/tms570/hwinit/init_pinmux.c

file.

The list tms570_selftest_par_list in the file

  rtems/c/src/lib/libbsp/arm/tms570/hwinit/bspstarthooks-hwinit.c

specifies peripherals which health status is examined
by parity self-test at BSP start-up. It can be easily
modified for other TMS570 family members variants same
as the selection of other tests in bspstarthooks-hwinit.c.
---
 .../arm/tms570/hwinit/tms570_selftest_par_std.c    | 90 ++++++++++++++++++++++
 1 file changed, 90 insertions(+)
 create mode 100644 c/src/lib/libbsp/arm/tms570/hwinit/tms570_selftest_par_std.c

(limited to 'c/src/lib/libbsp/arm/tms570/hwinit/tms570_selftest_par_std.c')

diff --git a/c/src/lib/libbsp/arm/tms570/hwinit/tms570_selftest_par_std.c b/c/src/lib/libbsp/arm/tms570/hwinit/tms570_selftest_par_std.c
new file mode 100644
index 0000000000..a9b20b5cb7
--- /dev/null
+++ b/c/src/lib/libbsp/arm/tms570/hwinit/tms570_selftest_par_std.c
@@ -0,0 +1,90 @@
+/**
+ * @file tms570_selftest_par_std.c
+ *
+ * @ingroup tms570
+ *
+ * @brief Generic parity based protection logic check applicable to HETx, HTUx, ADC, DMA and VIM.
+ */
+/*
+ * Copyright (c) 2016 Pavel Pisa <pisa@cmp.felk.cvut.cz>
+ *
+ * Czech Technical University in Prague
+ * Zikova 1903/4
+ * 166 36 Praha 6
+ * Czech Republic
+ *
+ * The license and distribution terms for this file may be
+ * found in the file LICENSE in this distribution or at
+ * http://www.rtems.org/license/LICENSE.
+ *
+ * Algorithms are based on Ti manuals and Ti HalCoGen generated
+ * code.
+ */
+
+#include <stdint.h>
+#include <stddef.h>
+#include <bsp/tms570.h>
+#include "tms570_selftest.h"
+#include "tms570_selftest_parity.h"
+
+/**
+ * @brief run test to check that parity protection works for modules with common setup structure.
+ *
+ * @param[in] desc module registers addresses end ESM channels descriptor
+ *
+ * @return Void, in the case of error invokes bsp_selftest_fail_notification()
+ *
+ * The descriptor provides address of the module registers and address
+ * of internal RAM memory and corresponding parity area test access window.
+ * This test function is usable for HETx, HTUx, ADC, DMA and VIM TMS570
+ * peripherals.
+ */
+void tms570_selftest_par_check_std( const tms570_selftest_par_desc_t *desc )
+{
+  volatile uint32_t test_read_data;
+  uint32_t          par_cr_bak = *desc->par_cr_reg;
+  int               perr;
+
+  /* Set TEST mode and enable parity checking */
+  *desc->par_cr_reg = desc->par_cr_test | TMS570_SELFTEST_PAR_CR_KEY;
+
+  /* flip parity bit */
+  *desc->par_loc ^= desc->par_xor;
+
+  /* Disable TEST mode */
+  *desc->par_cr_reg = TMS570_SELFTEST_PAR_CR_KEY;
+
+  /* read to cause parity error */
+  test_read_data = *desc->ram_loc;
+  (void) test_read_data;
+
+  /* check if ESM channel is flagged */
+  perr = tms570_esm_channel_sr_get( desc->esm_prim_grp, desc->esm_prim_chan );
+
+  if ( desc->esm_sec_grp )
+    perr |= tms570_esm_channel_sr_get( desc->esm_sec_grp, desc->esm_sec_chan );
+
+  if ( !perr ) {
+    /* RAM parity error was not flagged to ESM. */
+    bsp_selftest_fail_notification( desc->fail_code );
+  } else {
+    /* If periperal has it own parity status register, clear it */
+    if ( desc->par_st_reg != NULL )
+      *desc->par_st_reg = desc->par_st_clear;
+
+    /* clear ESM flag */
+    tms570_esm_channel_sr_clear( desc->esm_prim_grp, desc->esm_prim_chan );
+
+    if ( desc->esm_sec_grp )
+      tms570_esm_channel_sr_clear( desc->esm_sec_grp, desc->esm_sec_chan );
+
+    /* Set TEST mode and enable parity checking */
+    *desc->par_cr_reg = desc->par_cr_test | TMS570_SELFTEST_PAR_CR_KEY;
+
+    /* Revert back to correct data by flipping parity location */
+    *desc->par_loc ^= desc->par_xor;
+  }
+
+  /* Restore Parity comtrol register */
+  *desc->par_cr_reg = par_cr_bak;
+}
-- 
cgit v1.2.3