summaryrefslogtreecommitdiffstats
path: root/c/src/lib/libbsp/arm/tms570/hwinit/tms570_selftest_par_std.c
diff options
context:
space:
mode:
Diffstat (limited to 'c/src/lib/libbsp/arm/tms570/hwinit/tms570_selftest_par_std.c')
-rw-r--r--c/src/lib/libbsp/arm/tms570/hwinit/tms570_selftest_par_std.c90
1 files changed, 90 insertions, 0 deletions
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;
+}