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_mibspi.c | 105 +++++++++++++++++++++
 1 file changed, 105 insertions(+)
 create mode 100644 c/src/lib/libbsp/arm/tms570/hwinit/tms570_selftest_par_mibspi.c

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

diff --git a/c/src/lib/libbsp/arm/tms570/hwinit/tms570_selftest_par_mibspi.c b/c/src/lib/libbsp/arm/tms570/hwinit/tms570_selftest_par_mibspi.c
new file mode 100644
index 0000000000..2f693dad42
--- /dev/null
+++ b/c/src/lib/libbsp/arm/tms570/hwinit/tms570_selftest_par_mibspi.c
@@ -0,0 +1,105 @@
+/**
+ * @file tms570_selftest_par_can.c
+ *
+ * @ingroup tms570
+ *
+ * @brief Test MibSPI module parity based protection logic to work.
+ */
+/*
+ * 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 MibSPI modules RAM
+ *
+ * @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.
+ */
+void tms570_selftest_par_check_mibspi( const tms570_selftest_par_desc_t *desc )
+{
+  volatile uint32_t      test_read_data;
+  volatile tms570_spi_t *spi_regs = (volatile tms570_spi_t *) desc->fnc_data;
+  uint32_t               mibspie_bak;
+  uint32_t               uerrctl_bak;
+  int                    perr;
+  int                    wait_timeout = 10000;
+
+  /* wait for MibSPI RAM to complete initialization */
+  while ( ( spi_regs->FLG & TMS570_SPI_FLG_BUFINITACTIVE ) ==
+          TMS570_SPI_FLG_BUFINITACTIVE ) {
+    if ( !wait_timeout-- ) {
+      bsp_selftest_fail_notification( desc->fail_code );
+    }
+  }
+
+  /* Store previous configuration of MibSPI */
+  mibspie_bak = spi_regs->MIBSPIE;
+  uerrctl_bak = spi_regs->UERRCTRL;
+
+  /* enable multi-buffered mode */
+  spi_regs->MIBSPIE = TMS570_SPI_MIBSPIE_MSPIENA;
+
+  /* enable parity error detection */
+  spi_regs->UERRCTRL = TMS570_SPI_UERRCTRL_EDEN_SET( spi_regs->UERRCTRL,
+                                                    TMS570_SELFTEST_PAR_CR_KEY );
+
+  /* enable parity test mode */
+  spi_regs->UERRCTRL |= TMS570_SPI_UERRCTRL_PTESTEN;
+
+  /* flip parity bit */
+  *desc->par_loc ^= desc->par_xor;
+
+  /* disable parity TEST mode */
+  spi_regs->UERRCTRL &= ~TMS570_SPI_UERRCTRL_PTESTEN;
+
+  /* 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 ( !perr ) {
+    /* RAM parity error was not flagged to ESM. */
+    bsp_selftest_fail_notification( desc->fail_code );
+  } else {
+    /* clear parity error flags */
+    spi_regs->UERRSTAT = TMS570_SPI_UERRSTAT_EDFLG1 |
+                         TMS570_SPI_UERRSTAT_EDFLG0;
+
+    /* clear ESM flag */
+    tms570_esm_channel_sr_clear( desc->esm_prim_grp, desc->esm_prim_chan );
+
+    /* enable parity test mode */
+    spi_regs->UERRCTRL |= TMS570_SPI_UERRCTRL_PTESTEN;
+
+    /* Revert back to correct data by flipping parity location */
+    *desc->par_loc ^= desc->par_xor;
+  }
+
+  /* Restore MIBSPI control registers */
+  spi_regs->UERRCTRL = uerrctl_bak;
+  spi_regs->MIBSPIE = mibspie_bak;
+}
-- 
cgit v1.2.3