pasdk/test_dsp/sap/sap.c

   1
   2 /*
   3 Copyright (c) 2017, Texas Instruments Incorporated - http://www.ti.com/
   4 All rights reserved.
   5
   6 * Redistribution and use in source and binary forms, with or without
   7 * modification, are permitted provided that the following conditions
   8 * are met:
   9 *
  10 * Redistributions of source code must retain the above copyright
  11 * notice, this list of conditions and the following disclaimer.
  12 *
  13 * Redistributions in binary form must reproduce the above copyright
  14 * notice, this list of conditions and the following disclaimer in the
  15 * documentation and/or other materials provided with the
  16 * distribution.
  17 *
  18 * Neither the name of Texas Instruments Incorporated nor the names of
  19 * its contributors may be used to endorse or promote products derived
  20 * from this software without specific prior written permission.
  21 *
  22 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
  23 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
  24 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
  25 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
  26 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
  27 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
  28 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  29 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  30 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  31 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
  32 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  33 *
  34 */
  35
  36 //
  37 //
  38 // SIO driver implementation for audio I/O using McASP.
  39 //
  40 //
  41 //
  42
  43 #ifndef SAP_CACHE_SUPPORT
  44   // if you rebuild sap.c in your project without this defined,
  45   // the result is quite hard to find:  Occasional glitches in the sound.
  46   #define SAP_CACHE_SUPPORT  // typically defined in the project
  47 #endif
  48
  49 #ifdef SAP_CACHE_SUPPORT
  50 #include <ti/sysbios/hal/Cache.h>
  51 #endif
  52
  53 #include <stdlib.h>
  54 #include <stdio.h>
  55 #include <string.h> //memset
  56
  57 #include <xdc/std.h>
  58
  59 #include "sap.h"
  60
  61 #include <ti/sdo/edma3/drv/edma3_drv.h>
  62 #include <ti/sdo/edma3/drv/src/edma3.h>
  63 #include <ti/sdo/edma3/rm/edma3_rm.h>
  64 #include <ti/sdo/edma3/drv/sample/bios6_edma3_drv_sample.h>
  65
  66 #include <ti/csl/cslr_device.h>
  67
  68 #define EDMA_HINV NULL
  69 #define EDMA_NUM_PARAMS 6
  70
  71 #include "sap_mcasp.h"
  72 #include <pafsio.h>
  73
  74 // This works to set a breakpoint
  75 #define SW_BREAKPOINT       asm( " SWBP 0" );
  76
  77 // global allocated in bios_edma3_drv_sample_init.c
  78 extern EDMA3_DRV_Handle hEdma0;
  79 extern EDMA3_DRV_Handle hEdma1;
  80
  81 // global variables for debug-assist
  82 int gStartError;
  83 int gIsrInputCnt;
  84 int gIsrOutputCnt;
  85 int gIsrElseCnt;
  86 int gIsrInErrCnt;
  87 int gIsrOutErrCnt;
  88 int gIsrRunCnt;
  89 int gIsrNotRunCnt;
  90 int gisrOutput;
  91 int gSAPResetIn;
  92 int gSAPResetOut;
  93
  94 typedef xdc_Short MdInt;
  95
  96 void swapHdmi(Ptr, int);
  97
  98 #define SAP_UNDER_LEN 8
  99
 100 #pragma DATA_SECTION(sap_UNDER, ".sap_UNDER");
 101 int sap_UNDER[SAP_UNDER_LEN]; // used for underrun
 102 int sap_OVER_1LANE = 0;     // used for overrun
 103 int sap_OVER_4LANE[4] = {0,0,0,0};      // used for overrun
 104
 105 #ifdef DEBUG
 106 void SAP_EDMA_dumpParams(int tag_place)
 107 {
 108         //unsigned int *ptrPARAM_BASE = (unsigned int *)0x02704000;
 109         unsigned int *ptrPARAM0x18 = (unsigned int *)0x02704300; // ((*((EDMA3_CCRL_Regs *) 0x02700000)).PARAMENTRY)[24]
 110         //unsigned int *ptrPARAM0x19 = (unsigned int *)0x02704320; // ((*((EDMA3_CCRL_Regs *) 0x02700000)).PARAMENTRY)[24]
 111         //unsigned int *ptrPARAM0x41 = (unsigned int *)0x027048A0; // ((*((EDMA3_CCRL_Regs *) 0x02700000)).PARAMENTRY)[24]
 112         //unsigned int *ptrPARAM0x42 = (unsigned int *)0x027048C0; // ((*((EDMA3_CCRL_Regs *) 0x02700000)).PARAMENTRY)[24]
 113         //unsigned int *ptrPARAM0x43 = (unsigned int *)0x027048E0; // ((*((EDMA3_CCRL_Regs *) 0x02700000)).PARAMENTRY)[24]
 114         //unsigned int *ptrPARAM0x48 = (unsigned int *)0x02704910; // ((*((EDMA3_CCRL_Regs *) 0x02700000)).PARAMENTRY)[24]
 115         unsigned int *ptrPARAM0x45 = (unsigned int *)0x027048A0; // ((*((EDMA3_CCRL_Regs *) 0x02700000)).PARAMENTRY)[69]
 116         unsigned int *ptrPARAM0x46 = (unsigned int *)0x027048C0; // ((*((EDMA3_CCRL_Regs *) 0x02700000)).PARAMENTRY)[70]
 117         unsigned int *ptrPARAM0x47 = (unsigned int *)0x027048E0; // ((*((EDMA3_CCRL_Regs *) 0x02700000)).PARAMENTRY)[71]
 118         unsigned int *ptrPARAM0x48 = (unsigned int *)0x02704900; // ((*((EDMA3_CCRL_Regs *) 0x02700000)).PARAMENTRY)[72]
 119         unsigned int *ptrPARAM0x49 = (unsigned int *)0x02704920; // ((*((EDMA3_CCRL_Regs *) 0x02700000)).PARAMENTRY)[73]
 120         unsigned int *ptrPARAM0x4A = (unsigned int *)0x02704940; // ((*((EDMA3_CCRL_Regs *) 0x02700000)).PARAMENTRY)[74]
 121
 122         //Log_info5("PARAM0x18a(%d): 0x%x 0x%x 0x%x 0x%x", tag_place, ptrPARAM0x18[0], ptrPARAM0x18[1], ptrPARAM0x18[2], ptrPARAM0x18[3]);
 123         //Log_info5("PARAM0x18b(%d): 0x%x 0x%x 0x%x 0x%x", tag_place, ptrPARAM0x18[4], ptrPARAM0x18[5], ptrPARAM0x18[6], ptrPARAM0x18[7]);
 124
 125         /*Log_info5("PARAM0x19a(%d): ITCINTEN: 0x%02x, TCINTEN: 0x%02x, TCC: 0x%02x, TCCMODE: %d", tag_place, ((ptrPARAM0x19[0] & 0x200000) >> 21), ((ptrPARAM0x19[0] & 0x100000) >> 20), ((ptrPARAM0x19[0] & 0x3F000) >> 12), ((ptrPARAM0x19[0] & 0x800) >> 11));
 126         Log_info5("PARAM0x19b(%d): SRC: 0x%08x, A_B_CNT: 0x%08x, DST: 0x%08x,  SRC_DST_BIDX: 0x%08x", tag_place, ptrPARAM0x19[1], ptrPARAM0x19[2], ptrPARAM0x19[3], ptrPARAM0x19[4]);
 127         Log_info4("PARAM0x19b(%d): LINK_BCNTRLD: 0x%08x, SRC_DST_CIDX: 0x%08x, CCNT: 0x%08x", tag_place, ptrPARAM0x19[5], ptrPARAM0x19[6], ptrPARAM0x19[7]);
 128
 129         Log_info5("PARAM0x41a(%d): ITCINTEN: 0x%02x, TCINTEN: 0x%02x, TCC: 0x%02x, TCCMODE: %d", tag_place, ((ptrPARAM0x41[0] & 0x200000) >> 21), ((ptrPARAM0x41[0] & 0x100000) >> 20), ((ptrPARAM0x41[0] & 0x3F000) >> 12), ((ptrPARAM0x41[0] & 0x800) >> 11));
 130         Log_info5("PARAM0x41b(%d): SRC: 0x%08x, A_B_CNT: 0x%08x, DST: 0x%08x,  SRC_DST_BIDX: 0x%08x", tag_place, ptrPARAM0x41[1], ptrPARAM0x41[2], ptrPARAM0x41[3], ptrPARAM0x41[4]);
 131         Log_info4("PARAM0x41b(%d): LINK_BCNTRLD: 0x%08x, SRC_DST_CIDX: 0x%08x, CCNT: 0x%08x", tag_place, ptrPARAM0x41[5], ptrPARAM0x41[6], ptrPARAM0x41[7]);
 132
 133         Log_info5("PARAM0x42a(%d): ITCINTEN: 0x%02x, TCINTEN: 0x%02x, TCC: 0x%02x, TCCMODE: %d", tag_place, ((ptrPARAM0x42[0] & 0x200000) >> 21), ((ptrPARAM0x42[0] & 0x100000) >> 20), ((ptrPARAM0x42[0] & 0x3F000) >> 12), ((ptrPARAM0x42[0] & 0x800) >> 11));
 134         Log_info5("PARAM0x42b(%d): SRC: 0x%08x, A_B_CNT: 0x%08x, DST: 0x%08x,  SRC_DST_BIDX: 0x%08x", tag_place, ptrPARAM0x42[1], ptrPARAM0x42[2], ptrPARAM0x42[3], ptrPARAM0x42[4]);
 135         Log_info4("PARAM0x42b(%d): LINK_BCNTRLD: 0x%08x, SRC_DST_CIDX: 0x%08x, CCNT: 0x%08x", tag_place, ptrPARAM0x42[5], ptrPARAM0x42[6], ptrPARAM0x42[7]);
 136
 137         Log_info5("PARAM0x43a(%d): ITCINTEN: 0x%02x, TCINTEN: 0x%02x, TCC: 0x%02x, TCCMODE: %d", tag_place, ((ptrPARAM0x43[0] & 0x200000) >> 21), ((ptrPARAM0x43[0] & 0x100000) >> 20), ((ptrPARAM0x43[0] & 0x3F000) >> 12), ((ptrPARAM0x43[0] & 0x800) >> 11));
 138         Log_info5("PARAM0x43b(%d): SRC: 0x%08x, A_B_CNT: 0x%08x, DST: 0x%08x,  SRC_DST_BIDX: 0x%08x", tag_place, ptrPARAM0x43[1], ptrPARAM0x43[2], ptrPARAM0x43[3], ptrPARAM0x43[4]);
 139         Log_info4("PARAM0x43b(%d): LINK_BCNTRLD: 0x%08x, SRC_DST_CIDX: 0x%08x, CCNT: 0x%08x", tag_place, ptrPARAM0x43[5], ptrPARAM0x43[6], ptrPARAM0x43[7]);
 140
 141         Log_info5("PARAM0x48a(%d): ITCINTEN: 0x%02x, TCINTEN: 0x%02x, TCC: 0x%02x, TCCMODE: %d", tag_place, ((ptrPARAM0x48[0] & 0x200000) >> 21), ((ptrPARAM0x48[0] & 0x100000) >> 20), ((ptrPARAM0x48[0] & 0x3F000) >> 12), ((ptrPARAM0x48[0] & 0x800) >> 11));
 142         Log_info5("PARAM0x48b(%d): SRC: 0x%08x, A_B_CNT: 0x%08x, DST: 0x%08x,  SRC_DST_BIDX: 0x%08x", tag_place, ptrPARAM0x48[1], ptrPARAM0x48[2], ptrPARAM0x48[3], ptrPARAM0x48[4]);
 143         Log_info4("PARAM0x48b(%d): LINK_BCNTRLD: 0x%08x, SRC_DST_CIDX: 0x%08x, CCNT: 0x%08x", tag_place, ptrPARAM0x48[5], ptrPARAM0x48[6], ptrPARAM0x48[7]);*/
 144
 145         Log_info5("PARAM0x18a(%d): ITCINTEN: 0x%02x, TCINTEN: 0x%02x, TCC: 0x%02x, TCCMODE: %d", tag_place, ((ptrPARAM0x18[0] & 0x200000) >> 21), ((ptrPARAM0x18[0] & 0x100000) >> 20), ((ptrPARAM0x18[0] & 0x3F000) >> 12), ((ptrPARAM0x18[0] & 0x800) >> 11));
 146         Log_info5("PARAM0x18b(%d): SRC: 0x%08x, A_B_CNT: 0x%08x, DST: 0x%08x,  SRC_DST_BIDX: 0x%08x", tag_place, ptrPARAM0x18[1], ptrPARAM0x18[2], ptrPARAM0x18[3], ptrPARAM0x18[4]);
 147         Log_info4("PARAM0x18c(%d): LINK_BCNTRLD: 0x%08x, SRC_DST_CIDX: 0x%08x, CCNT: 0x%08x", tag_place, ptrPARAM0x18[5], ptrPARAM0x18[6], ptrPARAM0x18[7]);
 148
 149         Log_info5("PARAM0x45a(%d): ITCINTEN: 0x%02x, TCINTEN: 0x%02x, TCC: 0x%02x, TCCMODE: %d", tag_place, ((ptrPARAM0x45[0] & 0x200000) >> 21), ((ptrPARAM0x45[0] & 0x100000) >> 20), ((ptrPARAM0x45[0] & 0x3F000) >> 12), ((ptrPARAM0x45[0] & 0x800) >> 11));
 150         Log_info5("PARAM0x45b(%d): SRC: 0x%08x, A_B_CNT: 0x%08x, DST: 0x%08x,  SRC_DST_BIDX: 0x%08x", tag_place, ptrPARAM0x45[1], ptrPARAM0x45[2], ptrPARAM0x45[3], ptrPARAM0x45[4]);
 151         Log_info4("PARAM0x45c(%d): LINK_BCNTRLD: 0x%08x, SRC_DST_CIDX: 0x%08x, CCNT: 0x%08x", tag_place, ptrPARAM0x45[5], ptrPARAM0x45[6], ptrPARAM0x45[7]);
 152
 153         Log_info5("PARAM0x46a(%d): ITCINTEN: 0x%02x, TCINTEN: 0x%02x, TCC: 0x%02x, TCCMODE: %d", tag_place, ((ptrPARAM0x46[0] & 0x200000) >> 21), ((ptrPARAM0x46[0] & 0x100000) >> 20), ((ptrPARAM0x46[0] & 0x3F000) >> 12), ((ptrPARAM0x46[0] & 0x800) >> 11));
 154         Log_info5("PARAM0x46b(%d): SRC: 0x%08x, A_B_CNT: 0x%08x, DST: 0x%08x,  SRC_DST_BIDX: 0x%08x", tag_place, ptrPARAM0x46[1], ptrPARAM0x46[2], ptrPARAM0x46[3], ptrPARAM0x46[4]);
 155         Log_info4("PARAM0x46c(%d): LINK_BCNTRLD: 0x%08x, SRC_DST_CIDX: 0x%08x, CCNT: 0x%08x", tag_place, ptrPARAM0x46[5], ptrPARAM0x46[6], ptrPARAM0x46[7]);
 156
 157         Log_info5("PARAM0x47a(%d): ITCINTEN: 0x%02x, TCINTEN: 0x%02x, TCC: 0x%02x, TCCMODE: %d", tag_place, ((ptrPARAM0x47[0] & 0x200000) >> 21), ((ptrPARAM0x47[0] & 0x100000) >> 20), ((ptrPARAM0x47[0] & 0x3F000) >> 12), ((ptrPARAM0x47[0] & 0x800) >> 11));
 158         Log_info5("PARAM0x47b(%d): SRC: 0x%08x, A_B_CNT: 0x%08x, DST: 0x%08x,  SRC_DST_BIDX: 0x%08x", tag_place, ptrPARAM0x47[1], ptrPARAM0x47[2], ptrPARAM0x47[3], ptrPARAM0x47[4]);
 159         Log_info4("PARAM0x47c(%d): LINK_BCNTRLD: 0x%08x, SRC_DST_CIDX: 0x%08x, CCNT: 0x%08x", tag_place, ptrPARAM0x47[5], ptrPARAM0x47[6], ptrPARAM0x47[7]);
 160
 161         Log_info5("PARAM0x48a(%d): ITCINTEN: 0x%02x, TCINTEN: 0x%02x, TCC: 0x%02x, TCCMODE: %d", tag_place, ((ptrPARAM0x48[0] & 0x200000) >> 21), ((ptrPARAM0x48[0] & 0x100000) >> 20), ((ptrPARAM0x48[0] & 0x3F000) >> 12), ((ptrPARAM0x48[0] & 0x800) >> 11));
 162         Log_info5("PARAM0x48b(%d): SRC: 0x%08x, A_B_CNT: 0x%08x, DST: 0x%08x,  SRC_DST_BIDX: 0x%08x", tag_place, ptrPARAM0x48[1], ptrPARAM0x48[2], ptrPARAM0x48[3], ptrPARAM0x48[4]);
 163         Log_info4("PARAM0x48c(%d): LINK_BCNTRLD: 0x%08x, SRC_DST_CIDX: 0x%08x, CCNT: 0x%08x", tag_place, ptrPARAM0x48[5], ptrPARAM0x48[6], ptrPARAM0x48[7]);
 164
 165         Log_info5("PARAM0x49a(%d): ITCINTEN: 0x%02x, TCINTEN: 0x%02x, TCC: 0x%02x, TCCMODE: %d", tag_place, ((ptrPARAM0x49[0] & 0x200000) >> 21), ((ptrPARAM0x49[0] & 0x100000) >> 20), ((ptrPARAM0x49[0] & 0x3F000) >> 12), ((ptrPARAM0x49[0] & 0x800) >> 11));
 166         Log_info5("PARAM0x49b(%d): SRC: 0x%08x, A_B_CNT: 0x%08x, DST: 0x%08x,  SRC_DST_BIDX: 0x%08x", tag_place, ptrPARAM0x49[1], ptrPARAM0x49[2], ptrPARAM0x49[3], ptrPARAM0x49[4]);
 167         Log_info4("PARAM0x49c(%d): LINK_BCNTRLD: 0x%08x, SRC_DST_CIDX: 0x%08x, CCNT: 0x%08x", tag_place, ptrPARAM0x49[5], ptrPARAM0x49[6], ptrPARAM0x49[7]);
 168
 169         Log_info5("PARAM0x4Aa(%d): ITCINTEN: 0x%02x, TCINTEN: 0x%02x, TCC: 0x%02x, TCCMODE: %d", tag_place, ((ptrPARAM0x4A[0] & 0x200000) >> 21), ((ptrPARAM0x4A[0] & 0x100000) >> 20), ((ptrPARAM0x4A[0] & 0x3F000) >> 12), ((ptrPARAM0x4A[0] & 0x800) >> 11));
 170         Log_info5("PARAM0x4Ab(%d): SRC: 0x%08x, A_B_CNT: 0x%08x, DST: 0x%08x,  SRC_DST_BIDX: 0x%08x", tag_place, ptrPARAM0x4A[1], ptrPARAM0x4A[2], ptrPARAM0x4A[3], ptrPARAM0x4A[4]);
 171         Log_info4("PARAM0x4Ac(%d): LINK_BCNTRLD: 0x%08x, SRC_DST_CIDX: 0x%08x, CCNT: 0x%08x", tag_place, ptrPARAM0x4A[5], ptrPARAM0x4A[6], ptrPARAM0x4A[7]);
 172
 173         Log_info1("TCC0: ERR reg %x", *((unsigned int *)0x02760120));
 174 }
 175 #endif
 176 // .............................................................................
 177 // notes:
 178 //  . add control function to PORT table
 179 //  . how to handle DMA/PORT specifics in parameter entries
 180 //      can assume numSers = numChans is general and can be applied by DMA
 181 //      same for wordSize?
 182 //  . why are two idle stages needed (seems like 1 is enough)?
 183
 184 // .............................................................................
 185 // only one global variable, not static so that DMA and port functions
 186 // can access. We cant just store the address in devExt since the ISR has
 187 // no context.
 188
 189 SAP_DriverObject sapDrv;
 190
 191 // needed since SAP_watchDog is called before SAP_init
 192 Int SAP_initialized = 0;
 193
 194 Int  SAP_ctrl(DEV2_Handle, Uns, Arg);
 195 Int  SAP_idle(DEV2_Handle, Bool);
 196 Int  SAP_issue(DEV2_Handle);
 197 Int  SAP_open(DEV2_Handle, String);
 198 void SAP_isrCallback (Uint32 tcc, EDMA3_RM_TccStatus status, Ptr context);
 199 Int  SAP_reclaim(DEV2_Handle);
 200 Int  SAP_shutdown(DEV2_Handle);
 201 Int  SAP_start(DEV2_Handle);
 202 Int  SAP_config(DEV2_Handle device, const SAP_Params *pParams);
 203 Int  SAP_EDMA_setupParam (DEV2_Handle device, XDAS_UInt32 targetEdma, XDAS_UInt32 childEdma, XDAS_UInt32 addr, XDAS_UInt32 size);
 204 Int  SAP_EDMA_setupXfer (DEV2_Handle device, XDAS_UInt32 targetEdma, XDAS_UInt32 parentEdma, XDAS_UInt32 childEdma, DEV2_Frame *pFrame);
 205
 206 // .............................................................................
 207
 208 // .............................................................................
 209
 210 SAP_DMA_Fxns SAP_EDMA_FXNS =
 211 {
 212         SAP_EDMA_setupParam,
 213         SAP_EDMA_setupXfer,
 214 };
 215
 216
 217 SAP_Fxns SAP_FXNS =
 218 {
 219     NULL, //SAP_close, -- remove for IROM since not using
 220     SAP_ctrl,
 221     SAP_idle,
 222     SAP_issue,
 223     SAP_open,
 224     NULL, //SAP_ready, -- remove for IROM since not using
 225     SAP_reclaim,
 226     SAP_shutdown,
 227     SAP_start,
 228     SAP_config,
 229
 230 #ifdef SAP_PORT_MCASP
 231     (SAP_PORT_Fxns *) &SAP_MCASP_FXNS,
 232 #endif
 233 #ifdef SAP_DMA_EDMA
 234     (SAP_DMA_Fxns *) &SAP_EDMA_FXNS,
 235 #endif
 236 };
 237
 238 // -----------------------------------------------------------------------------
 239 // This function is not in the driver function table.
 240 // Must be pointed at in GUI config tool.
 241 //
 242 Void SAP_init (Void)
 243 {
 244     DEV2_Device  *entry;
 245     SAP_Fxns    *pFxns;
 246
 247     //TRACE_GEN((&TR_MOD, "SAP_init.%d", __LINE__));
 248
 249     // find function table pointer (used by SAP_XX_FTABLE_init macros)
 250     DEV2_match(SAP_NAME, &entry);
 251     if (entry == NULL) {
 252         Log_error1 ("SAP", SIO2_ENODEV);
 253         return;
 254     }
 255     pFxns = (SAP_Fxns *) entry->fxns;
 256
 257     //SAP_DMA_FTABLE_init ();
 258     SAP_PORT_FTABLE_init ();
 259
 260     sapDrv.numDevices = 0;
 261     SAP_initialized = 1;
 262
 263     return;
 264 } // SAP_init
 265
 266 // -----------------------------------------------------------------------------
 267
 268 int gSapInput_ControlOpen = 0;
 269 int gSapOutput_ControlOpen = 0;
 270
 271 int gSapInput_ControlClose = 0;
 272 int gSapOutput_ControlClose = 0;
 273
 274 Int SAP_ctrl (DEV2_Handle device, Uns code, Arg arg)
 275 {
 276     SAP_DeviceExtension *pDevExt = (SAP_DeviceExtension *)device->object;
 277     const SAP_Params *pParams;
 278     Int i, result = SIO2_OK;
 279     EDMA3_DRV_Handle    hEdma;
 280     //TRACE_GEN((&TR_MOD, "SAP_ctrl.%d (0x%x) code = 0x%x", __LINE__, device, code));
 281
 282     switch (code) {
 283
 284 /* .......................................................................... */
 285
 286         case PAF_SIO_CONTROL_MUTE:
 287         case PAF_SIO_CONTROL_UNMUTE:
 288             pParams = pDevExt->pParams;
 289             if (pParams == NULL)
 290                 return SIO2_OK;
 291
 292             if (pParams->sio.control != NULL)
 293                 result = pParams->sio.control (device, (const PAF_SIO_Params *)pParams, code, arg);
 294             break;
 295
 296 /* .......................................................................... */
 297
 298         case PAF_SIO_CONTROL_OPEN:
 299             if (pDevExt->runState)
 300                 return SIO2_EBUSY;
 301
 302             if (!( pParams = (const SAP_Params *) arg ))
 303                 return SIO2_OK;
 304
 305             if(device->mode == DEV2_OUTPUT)
 306                 gSapOutput_ControlOpen++;
 307             else
 308                 gSapInput_ControlOpen++;
 309
 310             if (result = SAP_FTABLE_config (device, pParams))
 311                 return result;
 312
 313             if (pParams->sio.control && (result = pParams->sio.control (device, (const PAF_SIO_Params *)pParams, code, arg)))
 314                 return result;
 315
 316             break;
 317
 318 /* .......................................................................... */
 319
 320         case PAF_SIO_CONTROL_CLOSE:
 321             if (pDevExt->runState)
 322                 return SIO2_EBUSY;
 323
 324             if (pDevExt->pParams == NULL)
 325                                 return SIO2_EINVAL;
 326
 327             pParams = pDevExt->pParams;
 328
 329                         if (pParams->sio.moduleNum == 0)
 330                                 hEdma = hEdma0;
 331                         else if (pParams->sio.moduleNum == 1 || pParams->sio.moduleNum == 2)
 332                                 hEdma = hEdma1;
 333
 334             if (pDevExt->activeEdma != EDMA_HINV) {
 335                                 EDMA3_DRV_freeChannel (hEdma, pDevExt->activeEdma);
 336                                 pDevExt->activeEdma = EDMA_HINV;
 337                         }
 338
 339             if(device->mode == DEV2_INPUT)
 340                 gSapInput_ControlClose++;
 341             else
 342                 gSapOutput_ControlClose++;
 343
 344             for (i=0; i < pDevExt->numEdmaParams; i++) {
 345                 if (pDevExt->edmaParams[i].hEdmaParam != EDMA_HINV)
 346                 {
 347                         EDMA3_DRV_freeChannel (hEdma, pDevExt->edmaParams[i].hEdmaParam);
 348                         pDevExt->edmaParams[i].hEdmaParam = EDMA_HINV;
 349                 }
 350             }
 351
 352             if (pDevExt->errorEdma != EDMA_HINV) {
 353                                 EDMA3_DRV_freeChannel (hEdma, pDevExt->errorEdma);
 354                                 pDevExt->errorEdma = EDMA_HINV;
 355                         }
 356
 357             if (!(pParams = pDevExt->pParams))
 358                 return SIO2_OK;
 359
 360             if (pParams->sio.control && (result = pParams->sio.control (device, (const PAF_SIO_Params *)pParams, code, arg)))
 361                 return result;
 362
 363             result = SAP_PORT_FTABLE_close (device);
 364             if (result)
 365                 return result;
 366
 367             pDevExt->pParams = NULL;
 368             break;
 369
 370 /* .......................................................................... */
 371
 372         case PAF_SIO_CONTROL_GET_WORDSIZE:
 373                 if (!arg)
 374                                 return SIO2_EINVAL;
 375                         *((int *) arg) = pDevExt->edmaWordSize;
 376             break;
 377
 378         case PAF_SIO_CONTROL_SET_WORDSIZE:
 379             // defer to DMA processing
 380                 // currently only supported for input
 381                         if (device->mode != DEV2_INPUT)
 382                                 return SIO2_EINVAL;
 383
 384                         // can't be running
 385                         if (pDevExt->runState)
 386                                 return SIO2_EBUSY;
 387
 388                         // driver only supports 2 or 4 bytes
 389                    if ((arg != 2) && (arg != 4))
 390                                 return SIO2_EINVAL;
 391
 392                         // return success for unconfigured devices?
 393                         if (!pDevExt->pParams)
 394                                 return SIO2_OK;
 395
 396                         // ask platform if size is supported
 397                         pParams = pDevExt->pParams;
 398                         if (pDevExt->pParams->sio.control && (result = pDevExt->pParams->sio.control (device, (const PAF_SIO_Params *)pParams, code, arg)))
 399                                 return result;
 400
 401                         pDevExt->edmaWordSize = arg;
 402                         break;
 403
 404         case PAF_SIO_CONTROL_GET_PRECISION:
 405             if (arg == 0)
 406                 return SIO2_EINVAL;
 407
 408             pParams = pDevExt->pParams;
 409             if (pParams == NULL)
 410                 return( SIO2_EINVAL );
 411
 412             *((int *) arg) = pParams->sio.precision;
 413             break;
 414
 415         case PAF_SIO_CONTROL_GET_NUMCHANNELS:
 416             if (arg == 0)
 417                 return SIO2_EINVAL;
 418
 419             *((int *) arg) = pDevExt->numSlots * pDevExt->numSers;
 420             break;
 421
 422         case PAF_SIO_CONTROL_SET_RATEX:
 423             pParams = pDevExt->pParams;
 424             if (pParams == NULL)
 425                 return SIO2_OK ;
 426
 427             if (pParams->sio.control == NULL)
 428                 return SIO2_EINVAL;
 429
 430             result = pParams->sio.control( device, (const PAF_SIO_Params *)pParams, PAF_SIO_CONTROL_SET_RATEX, arg);
 431             break;
 432
 433 /* .......................................................................... */
 434
 435         case PAF_SIO_CONTROL_IDLE:
 436             pParams = pDevExt->pParams;
 437             if (pParams == NULL)
 438                 return SIO2_OK ;
 439
 440             if (pParams->sio.control == NULL)
 441                 return SIO2_EINVAL;
 442
 443             result = pParams->sio.control( device, (const PAF_SIO_Params *)pParams, PAF_SIO_CONTROL_IDLE, arg);
 444             break;
 445
 446         case PAF_SIO_CONTROL_IDLE_WITH_CLOCKS:
 447             // 1. Here we are intentionally not using SIO_Idle() and
 448             //    leaving the Tx clock running. We need this to avoid DAC noise,
 449             //    as well as provide a DIT clock when using digital output.
 450             if (device->mode != DEV2_OUTPUT || pDevExt->pParams == NULL)
 451                 return SIO2_EINVAL;
 452
 453             pParams = pDevExt->pParams;
 454
 455             if (pParams->sio.moduleNum == 0)
 456                 hEdma = hEdma0;
 457             else if (pParams->sio.moduleNum == 1 || pParams->sio.moduleNum == 2)
 458                                 hEdma = hEdma1;
 459
 460             result = SAP_FTABLE_shutdown (device);
 461             if (result)
 462                 return result;
 463
 464             Log_info0 ("SAP PAF_SIO_CONTROL_IDLE_WITH_CLOCKS; PAF_SIO_ERROR_IDLE_STAGE1");
 465             pDevExt->errorState = PAF_SIO_ERROR_IDLE_STAGE1;
 466
 467             if (pDevExt->activeEdma != EDMA_HINV)
 468                 EDMA3_DRV_enableTransfer (hEdma, pDevExt->activeEdma, EDMA3_DRV_TRIG_MODE_EVENT);
 469
 470             //TRACE_GEN((&TR_MOD, "SAP_ctrl.%d: (0x%x) errorState = PAF_SIO_ERROR_IDLE_STAGE1 0x%x.", __LINE__, device, PAF_SIO_ERROR_IDLE_STAGE1));
 471
 472             break;
 473
 474 /* .......................................................................... */
 475
 476         case PAF_SIO_CONTROL_GET_INPUT_STATUS:
 477             // needs to be attached
 478             pParams = pDevExt->pParams;
 479             if (pParams == NULL)
 480                 return SIO2_OK;
 481
 482             if (pParams->sio.control == NULL)
 483                 return SIO2_EINVAL;
 484
 485             result = pParams->sio.control( device, (const PAF_SIO_Params *)pParams, code, arg );
 486             break;
 487
 488         case PAF_SIO_CONTROL_WATCHDOG:
 489             pParams = pDevExt->pParams;
 490             if (pParams == NULL)
 491                 return SIO2_OK;
 492             if (pParams->sio.control && (result = pParams->sio.control (device, (const PAF_SIO_Params *)pParams, code, arg)))
 493                 return result;
 494             break;
 495
 496 /* .......................................................................... */
 497
 498         // Timing stats specific to DMA engine
 499         case PAF_SIO_CONTROL_ENABLE_STATS:
 500         case PAF_SIO_CONTROL_DISABLE_STATS:
 501         case PAF_SIO_CONTROL_GET_STATS:
 502         case PAF_SIO_CONTROL_GET_NUM_EVENTS:
 503         case PAF_SIO_CONTROL_GET_NUM_REMAINING:
 504             //result = SAP_DMA_FTABLE_ctrl (device, code, arg);
 505             // TRACE_VERBOSE((&TR_MOD, "SAP_ctrl: (0x%x) code 0x%x.  result 0x%x.", device, code, result));
 506             break;
 507
 508 /* .......................................................................... */
 509
 510         case PAF_SIO_CONTROL_SET_DITSTATUS:
 511             if(device->mode == DEV2_OUTPUT)
 512             {
 513                 const SAP_Params *pParams = pDevExt->pParams;
 514                 MCASP_Handle hPort = sapMcaspDrv.hPort[pParams->sio.moduleNum];
 515                 volatile Uint32 *base = (volatile Uint32 *)(hPort->baseAddr);
 516                 MCASP_ConfigXmt *pTxConfig = (MCASP_ConfigXmt *)pParams->sio.pConfig;
 517                 int encSelect = *((int *) arg);
 518
 519                 // HACK -- determine DIT need by FXWID
 520                 if (((pTxConfig->afsxctl & _MCASP_AFSXCTL_FXWID_MASK)>> _MCASP_AFSXCTL_FXWID_SHIFT) == MCASP_AFSXCTL_FXWID_BIT)
 521                 {
 522                     if ( (encSelect == 0x13) ||
 523                          (encSelect == 0xa)  ||
 524                          (encSelect == 0x6)) // DTE, DDE, MPE
 525                     {
 526                         base[_MCASP_DITCSRA0_OFFSET] |= 2;
 527                         base[_MCASP_DITCSRB0_OFFSET] |= 2;
 528                     }
 529                     else
 530                     {
 531                         base[_MCASP_DITCSRA0_OFFSET] &= 0xfffffffd;
 532                         base[_MCASP_DITCSRB0_OFFSET] &= 0xfffffffd;
 533                     }
 534                 }
 535
 536                 pParams = pDevExt->pParams;
 537                 if (pParams == NULL)
 538                     return SIO2_OK;
 539
 540                 if (pParams->sio.control != NULL)
 541                     result = pParams->sio.control (device, (const PAF_SIO_Params *)pParams, code, arg);
 542             }
 543             break;
 544
 545 /* .......................................................................... */
 546
 547     }
 548
 549     return result;
 550 } // SAP_ctrl
 551
 552 int gSAPIdleShutdownIn=0;
 553 int gSAPIdleShutdownOut=0;
 554
 555 // -----------------------------------------------------------------------------
 556
 557 Int SAP_idle (DEV2_Handle device, Bool flush)
 558 {
 559     SAP_DeviceExtension *pDevExt = (SAP_DeviceExtension *)device->object;
 560     Int result = SIO2_OK;
 561     EDMA3_DRV_Handle hEdma;
 562
 563     // do nothing if already idled or unattached
 564     if ((!pDevExt->runState) || (pDevExt->pParams == NULL))
 565         return result;
 566
 567         if (pDevExt->pParams->sio.moduleNum == 0)
 568                 hEdma = hEdma0;
 569         else if (pDevExt->pParams->sio.moduleNum == 1 || pDevExt->pParams->sio.moduleNum == 2)
 570                 hEdma = hEdma1;
 571
 572     // reset serial port -- stop generating sync events
 573     result = SAP_PORT_FTABLE_reset (device);
 574     if(device->mode == DEV2_OUTPUT)
 575         gSAPResetOut++;
 576     else
 577         gSAPResetIn++;
 578     if (result)
 579     {
 580         //TRACE_VERBOSE((&TR_MOD, "%s.%d: SAP_PORT_FTABLE_reset returned %d.\n", __FUNCTION__, __LINE__, result));
 581         return result;
 582     }
 583
 584     pDevExt->shutDown = 0; // force shutdown to run
 585     result = SAP_FTABLE_shutdown (device);
 586     if(device->mode == DEV2_OUTPUT)
 587         gSAPIdleShutdownOut++;
 588     else
 589         gSAPIdleShutdownIn++;
 590
 591     if (result)
 592     {
 593         //TRACE_VERBOSE((&TR_MOD, "%s.%d: SAP_FTABLE_shutdown returned %d.\n", __FUNCTION__, __LINE__, result));
 594         return result;
 595     }
 596
 597     Log_info0("SAP_idle:Before EDMA3_DRV_disableTransfer");
 598
 599     // disable interrupts and EDMA servicing
 600    if (pDevExt->activeEdma != EDMA_HINV)
 601            EDMA3_DRV_disableTransfer (hEdma, pDevExt->activeEdma, EDMA3_DRV_TRIG_MODE_EVENT);
 602
 603    Log_info0("SAP_idle:Before pDevExt->numQueued = 0");
 604    pDevExt->numQueued = 0;
 605
 606     // signal stopped
 607     pDevExt->runState = 0;
 608     Log_info0("SAP_idle: runState = 0");
 609
 610     // reset errorState
 611     pDevExt->errorState = PAF_SIO_ERROR_NONE;
 612     //TRACE_VERBOSE((&TR_MOD, "SAP_ctrl.%d: errorState = PAF_SIO_ERROR_NONE 0x%x.", __LINE__, PAF_SIO_ERROR_NONE));
 613
 614     // place call to physical device
 615     if ((pDevExt->pParams != NULL) && (pDevExt->pParams->sio.control != NULL))
 616         result = pDevExt->pParams->sio.control(device, (const PAF_SIO_Params *)pDevExt->pParams, PAF_SIO_CONTROL_IDLE, 0);
 617
 618     return result;
 619 } // SAP_idle
 620
 621 // -----------------------------------------------------------------------------
 622
 623 Int SAP_start (DEV2_Handle device)
 624 {
 625     SAP_DeviceExtension *pDevExt = (SAP_DeviceExtension *)device->object;
 626     DEV2_Frame *pFrame;
 627     int result;
 628     EDMA3_DRV_Handle hEdma;
 629
 630     Log_info2("SAP_start.%d (0x%x)", __LINE__, (xdc_IArg)device);
 631
 632     // Assume todevice queue is not empty -- how else could we be here?
 633     pFrame = (DEV2_Frame *) Queue_get (device->todevice);
 634
 635     // inidicate this xfer did not use param entry - just the active one
 636     pFrame->misc = NULL;
 637     if (pDevExt->pParams->sio.moduleNum == 0)
 638         hEdma = hEdma0;
 639     else if (pDevExt->pParams->sio.moduleNum == 1 || pDevExt->pParams->sio.moduleNum == 2)
 640                 hEdma = hEdma1;
 641
 642     // non-atomic functions since not running yet.
 643     Queue_enqueue (Queue_handle(&pDevExt->xferQue), (Queue_Elem *)pFrame);
 644
 645     // initialize count
 646     pDevExt->numQueued = 1;
 647
 648     result = SAP_PORT_FTABLE_reset (device);
 649     if (result)
 650     {
 651         //TRACE_VERBOSE((&TR_MOD, "%s.%d: SAP_PORT_FTABLE_reset returned %d.\n", __FUNCTION__, __LINE__, result));
 652         return result;
 653     }
 654
 655     // enable DMA processing
 656     if (device->mode == DEV2_OUTPUT)
 657         Log_info3("SAP_start.%d, pDevExt->activeEdma 0x%x (pDevExt->errorEdma = 0x%x)",
 658                             __LINE__, pDevExt->activeEdma, pDevExt->errorEdma);
 659     // config active xfer for this buffer
 660     result = SAP_EDMA_setupXfer(device, pDevExt->activeEdma, EDMA_HINV, pDevExt->errorEdma, pFrame);
 661
 662
 663         // signal we have started -- this must come before last enable to prevent a race
 664         // condition where the initial EDMA transfer is very small (e.g. due to startClocks)
 665         // and completes before any further instructions in this thread are executed.
 666         // This comes before the EDMA enable since, if the # of samples is 1, then the EDMA
 667         // will be serviced and generate an interrupt even before the McASP is enabled.
 668     pDevExt->runState = 1;
 669     pDevExt->shutDown = 0;
 670     if (device->mode == DEV2_OUTPUT)
 671         Log_info2 ("SAP: %d, SAP_start runState=1 & ENABLE TRANSFERS for activeEdma = 0x%x", __LINE__, pDevExt->activeEdma);
 672         // enable interrupts and event servicing for this channel
 673         EDMA3_DRV_enableTransfer (hEdma, pDevExt->activeEdma, EDMA3_DRV_TRIG_MODE_EVENT);
 674
 675     // enable peripheral
 676     result = SAP_PORT_FTABLE_enable (device);
 677
 678     if (result)
 679     {
 680         //TRACE_VERBOSE((&TR_MOD, "%s.%d: SAP_PORT_FTABLE_enable returned %d.\n", __FUNCTION__, __LINE__, result));
 681         return result;
 682     }
 683
 684     return SIO2_OK;
 685 } // SAP_start
 686
 687 int gDmaParamsarray[17][3];
 688 int gDmaParamsidx=0, gSAPSpecialCase=0;
 689 // -----------------------------------------------------------------------------
 690
 691 Int SAP_issue (DEV2_Handle device)
 692 {
 693     SAP_DeviceExtension *pDevExt = (SAP_DeviceExtension *)device->object;
 694     DEV2_Frame *pFrame;
 695     Int result;
 696     SAP_EDMA_Param *pParam;
 697     XDAS_UInt32 parentEdma;
 698
 699     if (device->mode == DEV2_OUTPUT)
 700         Log_info3("SAP_issue for output device with pDevExt->errorState = 0x%x, pDevExt->runState = 0x%x, pDevExt->numQueued = 0x%x", pDevExt->errorState, pDevExt->runState, pDevExt->numQueued);
 701
 702     if ((device->mode == DEV2_OUTPUT) && (pDevExt->errorState >= PAF_SIO_ERROR_ERRBUF_XFER))
 703     {
 704         /*TRACE_TERSE((&TR_MOD, "SAP_issue.%d, errorState 0x%x (PAF_SIO_ERROR_ERRBUF_XFER = 0x%x)",
 705             __LINE__, pDevExt->errorState, PAF_SIO_ERROR_ERRBUF_XFER));*/
 706         Log_info3("SAP_issue.%d, PAF_SIO_ERROR_ERRBUF_XFER = 0x%x, mode = 0x%x)",
 707                 __LINE__, PAF_SIO_ERROR_ERRBUF_XFER, device->mode );
 708         return SIO2_EBADIO;
 709     }
 710
 711     if ((device->mode == DEV2_INPUT) && pDevExt->errorState)
 712         {
 713                 Log_info1("SAP_issue: Input Error Trap, with errorState = 0x%x", pDevExt->errorState);
 714             return SIO2_EBADIO;
 715         }
 716
 717     // if not yet running then configure active xfer and start
 718     if (pDevExt->runState == 0)
 719         return (SAP_FTABLE_start(device));
 720
 721     // .........................................................................
 722     // here if running
 723
 724     // disable device interrupts
 725     // TODO: is there an API to just disable the IER bit for this tcc?
 726     unsigned int key = Hwi_disable ();
 727        /* determine parent EDMA
 728           if no xfers in queue and we are running then must be in the
 729           error state so link to active channel otherwise link to last
 730           transfer queued.
 731        */
 732
 733        /* here we assume after Tx SIO_idle or overrun, the user
 734           will issue, at least, back-to-back issue requests so
 735           there should be no problem here.
 736        */
 737        if ((pDevExt->numQueued <= 1) && (pDevExt->errorState != 2))
 738            parentEdma = pDevExt->activeEdma;
 739        else {
 740            // if here then xferQue has more than one element so ok to use tail
 741            // last scheduled transfer must be queue->prev
 742            DEV2_Frame *tail = (DEV2_Frame *) Queue_prev ((Queue_Elem *)&pDevExt->xferQue);
 743            parentEdma = ((SAP_EDMA_Param *) tail->misc)->hEdmaParam;
 744        }
 745
 746        //if (device->mode == DEV2_OUTPUT)
 747            Log_info2("SAP_issue: Determined Parent = 0x%x for device = 0x%x", parentEdma, device->mode );
 748
 749     // get frame and parameter table to use; ints off => non-atomic OK
 750     //     dont need to check for empty queues since were here then todevice
 751     //     must have a frame placed there by the SIO_issue layer.
 752     //     paramQue must be valid since it is accessed the same as todevice.
 753     //     (indirectly -- isr places used items onto paramQue and fromdevice que
 754     //      at the same time)
 755     // set misc argument to pParam so get enqueue later
 756     //pFrame = (DEV2_Frame *) Queue_dequeue (device->todevice);
 757     pFrame = Queue_dequeue (device->todevice);
 758     pParam = (SAP_EDMA_Param *) Queue_dequeue (Queue_handle(&pDevExt->paramQue));
 759
 760     if (pParam->hEdmaParam == NULL)
 761         Log_info1("SAP_issue: hEdma value is NULL for device = 0x%x", device->mode);
 762     // set misc argument to pParam so get enqueue later
 763     pFrame->misc = (Arg) pParam;
 764
 765     // place on holder queue, ints off => non-atomic OK
 766     Queue_enqueue (Queue_handle(&pDevExt->xferQue), (Queue_Elem *) pFrame);
 767     if (pFrame->addr) {
 768                 if (device->mode == DEV2_INPUT)
 769                         Cache_inv (pFrame->addr, pFrame->size, Cache_Type_ALL, TRUE);
 770                 else
 771                         Cache_wbInv (pFrame->addr, pFrame->size, Cache_Type_ALL, TRUE);
 772         }
 773
 774     // increment count
 775     pDevExt->numQueued += 1;
 776
 777     result = SAP_EDMA_setupXfer (device, pParam->hEdmaParam, parentEdma, pDevExt->errorEdma, pFrame);
 778     if (device->mode == DEV2_OUTPUT)
 779     {
 780         Log_info4("SAP_issue.%d, EDMA_setupXfer: Target EDMA: 0x%x, Parent Edma: 0x%x Error Edma: 0x%x",
 781                             __LINE__, pParam->hEdmaParam, parentEdma, pDevExt->errorEdma);
 782     }
 783
 784         if ((pDevExt->errorState == PAF_SIO_ERROR_IDLE_STAGE1) && (device->mode == DEV2_OUTPUT))
 785                 pDevExt->errorState = PAF_SIO_ERROR_NONE;
 786
 787         pDevExt->shutDown = 0;
 788
 789     // special case enables when not yet started
 790     if (pDevExt->runState == 0) {
 791         gSAPSpecialCase++;
 792         result = SAP_FTABLE_start (device);
 793         if (result) {
 794                   Hwi_restore (key);
 795             return result;
 796         }
 797     }
 798     Hwi_restore (key);
 799
 800     return result;
 801 } // SAP_issue
 802
 803 // -----------------------------------------------------------------------------
 804
 805 void swapHdmi(Ptr Input, int size)
 806 {
 807
 808         MdInt L0, L1, L2, L3, R0, R1, R2, R3 = 0;
 809         MdInt *p1, *p2;
 810         int i=0;
 811
 812         for (i=0; i< size; i+=16)
 813         {
 814                         p1 = (MdInt *)&Input[i];
 815                         p2 = p1;
 816
 817                         L0 = *p1++;
 818                         L1 = *p1++;
 819                         L2 = *p1++;
 820                         L3 = *p1++;
 821                         R0 = *p1++;
 822                         R1 = *p1++;
 823                         R2 = *p1++;
 824                         R3 = *p1++;
 825
 826                         *p2++ = L0;
 827                         *p2++ = R0;
 828                         *p2++ = L1;
 829                         *p2++ = R1;
 830                         *p2++ = L2;
 831                         *p2++ = R2;
 832                         *p2++ = L3;
 833                         *p2++ = R3;
 834
 835         }
 836
 837         Log_info3("SAP: Exiting swapHdmi with Frame->Addr: 0x%x, p1->addr: 0x%x, p2->addr: 0x%x ", (xdc_IArg)Input, (xdc_IArg)p1, (xdc_IArg)p2);
 838
 839         return;
 840 }
 841
 842 Int SAP_reclaim (DEV2_Handle device)
 843 {
 844     SAP_DeviceExtension *pDevExt = (SAP_DeviceExtension *)(device->object);
 845 #ifdef SAP_CACHE_SUPPORT
 846     DEV2_Frame *pFrame;
 847 #endif
 848
 849     //TRACE_GEN((&TR_MOD, "SAP_reclaim.%d (0x%x)", __LINE__, device));
 850     if (device->mode == DEV2_OUTPUT)
 851                 Log_info3("SAP_reclaim for output device with pDevExt->errorState = 0x%x, runState: 0x%x & pDevExt->numQueued = 0x%x", pDevExt->errorState, pDevExt->runState, pDevExt->numQueued);
 852     // must be running and  error free
 853     if ((!pDevExt->runState) || (pDevExt->errorState))
 854     {
 855         Log_info3("SAP_reclaim.%d, error-state: 0x%x, mode = 0x%x", __LINE__, pDevExt->errorState, device->mode);
 856         return SIO2_EBADIO;
 857     }
 858
 859     Log_info1("SAP_reclaim: Before SEM Pend for mode: 0x%x", device->mode);
 860
 861     // wait for ISR to signal block completion
 862     //TRACE_VERBOSE((&TR_MOD, "SAP_reclaim.%d wait for ISR to signal block completion", __LINE__));
 863     if (!Semaphore_pend(pDevExt->sync, device->timeout))
 864     {
 865         Log_info0("SAP_reclaim, SYS_ETIMEOUT");
 866         return SIO2_ETIMEOUT;
 867     }
 868     Log_info1("SAP_reclaim: After SEM Pend for mode: 0x%x", device->mode);
 869
 870     // return error (owner must idle)
 871     if (pDevExt->errorState == PAF_SIO_ERROR_FATAL)
 872     {
 873         DEV2_idle (device, 1);
 874         Log_info2("SAP_reclaim.%d, PAF_SIO_ERROR_FATAL: 0x%x", __LINE__, pDevExt->errorState);
 875         return PAF_SIO_ERROR_FATAL;
 876     }
 877
 878 #ifdef SAP_CACHE_SUPPORT
 879     // invalidate CACHE region if input -- use clean since
 880     //    Dont clean if was for fill.
 881     // since pend returned we know that head of fromdevice is valid
 882     pFrame = Queue_head (device->fromdevice);
 883     Log_info2("SAP: Inside SAP_Reclaim with From Device Frame->Addr: 0x%x and Frame->Size: %d", (xdc_IArg)pFrame->addr, pFrame->size);
 884     if ((device->mode == DEV2_INPUT) && (pFrame->addr != NULL))
 885     {
 886         if(pDevExt->edmaWordSize == 2 && pDevExt->numSers == 4)
 887         {
 888             Cache_inv (pFrame->addr, pFrame->size, Cache_Type_ALL, 0);
 889             Cache_wait();
 890
 891             // max HWI disable duration ~1ms observed
 892             //unsigned int key = Hwi_disable ();                    // GJ: Revisit, along with other context protections here.
 893             swapHdmi(pFrame->addr, pFrame->size);
 894             //Hwi_restore(key);
 895
 896             Cache_wb (pFrame->addr, pFrame->size, Cache_Type_ALL, 0);
 897             Cache_wait();
 898         }
 899     }
 900
 901 #endif
 902     /*if ((device->mode == DEV2_OUTPUT) && (pFrame->addr == NULL))
 903         SW_BREAKPOINT; */
 904
 905     Log_info1("SAP_reclaim: Exiting with SIO2_OK for device 0x%x  ", device->mode);
 906     //TRACE_VERBOSE((&TR_MOD, "SAP_reclaim.%d, exit SIO2_OK", __LINE__));
 907     return SIO2_OK;
 908 } // SAP_reclaim
 909
 910
 911 // -----------------------------------------------------------------------------
 912
 913 Int SAP_open (DEV2_Handle device, String name)
 914 {
 915     SAP_DeviceExtension   *pDevExt;
 916     DEV2_Device            *entry;
 917     Int                    oldMask, result;
 918     Error_Block                         eb;
 919     //TRACE_GEN((&TR_MOD, "SAP_open.%d (0x%x)", __LINE__, device));
 920
 921     // check SIO mode
 922     if ((device->mode != DEV2_INPUT) && (device->mode != DEV2_OUTPUT))
 923         return SIO2_EMODE;
 924
 925     // allocate memory for device extension
 926     device->object = NULL;
 927     pDevExt = (SAP_DeviceExtension *) Memory_alloc (device->bufSeg, (sizeof(SAP_DeviceExtension)+3)/4*4, 4, &eb);
 928     if (pDevExt == NULL)
 929     {
 930         printf("%s.%d:  MEM_alloc failed.\n", __FUNCTION__, __LINE__);
 931         //TRACE_TERSE((&TR_MOD, "%s.%d:  MEM_alloc failed.\n", __FUNCTION__, __LINE__));
 932         asm( " SWBP 0" );  // SW Breakpoint
 933         return SIO2_EALLOC;
 934     }
 935     device->object = (Ptr)pDevExt;
 936
 937     // inits
 938     pDevExt->device = device;
 939     pDevExt->sync = NULL;
 940     pDevExt->pParams = NULL;
 941     pDevExt->runState = 0;  // not yet started
 942     pDevExt->errorState = PAF_SIO_ERROR_NONE;
 943     pDevExt->shutDown = 1;
 944     pDevExt->numQueued = 0;
 945     pDevExt->activeEdma = EDMA_HINV;
 946     pDevExt->errorEdma = EDMA_HINV;
 947     pDevExt->firstTCC = 0;
 948     pDevExt->optLevel = 0;
 949     pDevExt->numParamSetup = 0;
 950     pDevExt->numEdmaParams = EDMA_NUM_PARAMS;           // We need more than 4 spare params to handle the immediate transition from Unknown
 951                                                                                                 // to a Known program. Cheap resource to spend.
 952
 953     // use dev match to fetch function table pointer for SAP
 954     DEV2_match(SAP_NAME, &entry);
 955     if (entry == NULL) {
 956         Log_error1("SAP", SIO2_ENODEV);
 957         return SIO2_ENODEV;
 958     }
 959     pDevExt->pFxns = (SAP_Fxns *) entry->fxns;
 960
 961     // create semaphore for device
 962     pDevExt->sync = Semaphore_create (0, NULL, NULL);
 963     if (pDevExt->sync == NULL)
 964     {
 965         //TRACE_TERSE((&TR_MOD, "%s.%d: create semaphore for device failed.\n", __FUNCTION__, __LINE__));
 966         return SIO2_EALLOC;
 967     }
 968
 969     // queue inits
 970     Queue_construct (&pDevExt->xferQue, NULL);
 971     Queue_construct (&pDevExt->paramQue, NULL);
 972
 973     // update driver global (need to protect context)
 974     if (sapDrv.numDevices >= MAX_SAP_DEVICES)
 975     {
 976         /*TRACE_TERSE((&TR_MOD, "%s.%d: add device failure: no. of devices = %d; need to increase MAX_SAP_DEVICES.\n",
 977             __FUNCTION__, __LINE__, dapDrv.numDevices));*/
 978         SW_BREAKPOINT;
 979     }
 980     oldMask = Hwi_disable ();
 981     sapDrv.device[sapDrv.numDevices] = device;
 982     pDevExt->deviceNum = sapDrv.numDevices++;
 983     Hwi_restore (oldMask);
 984
 985     // PORT init
 986     result = SAP_PORT_FTABLE_open (device);
 987     if (result)
 988     {
 989         //TRACE_TERSE((&TR_MOD, "%s.%d: SAP_PORT_FTABLE_open returned %d.\n", __FUNCTION__, __LINE__, result));
 990         return result;
 991     }
 992
 993     return result;
 994 } // SAP_open
 995
 996 // -----------------------------------------------------------------------------
 997
 998 Int SAP_config (DEV2_Handle device, const SAP_Params *pParams)
 999 {
1000     SAP_DeviceExtension *pDevExt = (SAP_DeviceExtension *)device->object;
1001     Int                  result, Que_num, i;
1002     EDMA3_DRV_Result     edmaResult;
1003     Uint32                                      reqTcc;
1004     EDMA3_DRV_Handle    hEdma;
1005     Log_info2("SAP_config.%d (0x%x)", __LINE__, (xdc_IArg)device);
1006
1007     // cannot configure if transfer started
1008     if (pDevExt->runState == 1)
1009         return SIO2_EBADIO;
1010
1011     // save pointer to config structure in device extension. here so that
1012     //   forthcoming functions can use/modify config structure.
1013     pDevExt->pParams = pParams;
1014     pDevExt->edmaWordSize = pParams->sio.wordSize;
1015
1016     // allocate Port resources.
1017     //    This must come before DMA configuration
1018     result = SAP_PORT_FTABLE_alloc (device);
1019     if (result)
1020     {
1021         Log_info3("%s.%d: SAP_PORT_FTABLE_alloc returned %d.\n", (xdc_IArg) __FUNCTION__, __LINE__, result);
1022         return result;
1023     }
1024
1025     // .............................................................................
1026     // EDMA configuration
1027
1028     // DA10x McASP0 Specific
1029     if (pParams->sio.moduleNum == 0)
1030     {
1031         hEdma = hEdma0;
1032         if (device->mode == DEV2_INPUT)
1033         {
1034                 Que_num = 0;
1035                 pDevExt->activeEdma = CSL_EDMACC_0_McASP_0_REVT;
1036         }
1037         else
1038         {
1039                 Que_num = 0;
1040                 pDevExt->activeEdma = CSL_EDMACC_0_McASP_0_XEVT;
1041         }
1042     }
1043     // DA10x McASP1 Specific
1044     else if (pParams->sio.moduleNum == 1)
1045     {
1046         hEdma = hEdma1;
1047         if (device->mode == DEV2_INPUT)
1048                 {
1049                 Que_num = 0;
1050                 pDevExt->activeEdma = CSL_EDMACC_1_McASP_1_REVT;
1051                 }
1052                 else
1053                 {
1054                         Que_num = 0;
1055                         pDevExt->activeEdma = CSL_EDMACC_1_McASP_1_XEVT;
1056                 }
1057     }
1058     // DA10x McASP2 Specific
1059     else if (pParams->sio.moduleNum == 2)
1060     {
1061         hEdma = hEdma1;
1062         if (device->mode == DEV2_INPUT)
1063                 {
1064                         Que_num = 0;
1065                         pDevExt->activeEdma = CSL_EDMACC_1_McASP_2_REVT;
1066                 }
1067                 else
1068                 {
1069                         Que_num = 0;
1070                         pDevExt->activeEdma = CSL_EDMACC_1_McASP_2_XEVT;
1071                 }
1072     }
1073
1074
1075     for (i=0; i < pDevExt->numEdmaParams; i++) {
1076
1077         reqTcc = EDMA3_DRV_TCC_ANY;
1078         pDevExt->edmaParams[i].hEdmaParam = EDMA3_DRV_LINK_CHANNEL;
1079         edmaResult = EDMA3_DRV_requestChannel (
1080                 hEdma,
1081             &pDevExt->edmaParams[i].hEdmaParam,
1082             &reqTcc,
1083             (EDMA3_RM_EventQueue) Que_num,
1084             SAP_isrCallback,
1085             (void *) device);
1086
1087         if (edmaResult != EDMA3_DRV_SOK)
1088             return SIO2_EALLOC;
1089
1090         //not running => can use non-atomic functions
1091         Queue_enqueue (Queue_handle(&pDevExt->paramQue), (Queue_Elem *)&pDevExt->edmaParams[i]);
1092
1093     }
1094
1095     reqTcc = EDMA3_DRV_TCC_ANY;
1096         pDevExt->errorEdma = EDMA3_DRV_LINK_CHANNEL;
1097         edmaResult = EDMA3_DRV_requestChannel (
1098             hEdma,
1099             &pDevExt->errorEdma,
1100             &reqTcc,
1101             (EDMA3_RM_EventQueue)Que_num,
1102             SAP_isrCallback,
1103             (void *) device);
1104         if (edmaResult != EDMA3_DRV_SOK)
1105             return SIO2_EALLOC;
1106
1107         // allocate edma channel -- also disable and clear the interrupt
1108
1109
1110         pDevExt->firstTCC = pDevExt->activeEdma ;
1111         edmaResult = EDMA3_DRV_requestChannel (
1112                 hEdma,
1113                 &pDevExt->activeEdma,
1114                 &pDevExt->firstTCC,
1115                 (EDMA3_RM_EventQueue) 0,
1116                 SAP_isrCallback,
1117                 (void *) device);
1118         if (edmaResult != EDMA3_DRV_SOK)
1119                     {
1120                         Log_info3("%s.%d: SAP_DMA_FTABLE_alloc returned %d.\n", (xdc_IArg)__FUNCTION__, __LINE__, edmaResult);
1121                         return SIO2_EALLOC;
1122                     }
1123
1124         // Configure error transfer
1125         //   make cnt same as # of channels in order to maintain alignment
1126         //   and the error transfer small so that we never have to wait
1127         //   long for it to complete and trigger a linked transfer. This is
1128         //   important for establishing output timing when we are idling with
1129         //   clocks still running. Is fine for Rx as well.
1130         result = SAP_DMA_FTABLE_setupParam (device, pDevExt->errorEdma, pDevExt->errorEdma, NULL, pDevExt->edmaWordSize * pDevExt->numSers);
1131
1132         Log_info3("%s.%d: Exiting SAP_alloc for %d.\n", (xdc_IArg)__FUNCTION__, __LINE__, pDevExt->activeEdma);
1133
1134     return SIO2_OK;
1135 } // SAP_config
1136
1137 // -----------------------------------------------------------------------------
1138
1139 Int SAP_shutdown (DEV2_Handle device)
1140 {
1141     SAP_DeviceExtension *pDevExt = (SAP_DeviceExtension *)(device->object);
1142     SIO2_Handle stream = (SIO2_Handle) device;
1143     DEV2_Frame *pFrame;
1144     Int i;
1145     EDMA3_DRV_Handle hEdma;
1146     //TRACE_GEN((&TR_MOD, "SAP_shutdown.%d (0x%x)", __LINE__, device));
1147
1148     if (pDevExt->shutDown)
1149         return SIO2_EBADIO;
1150
1151     if (pDevExt->pParams == NULL)
1152         return SIO2_EINVAL;
1153
1154     if (pDevExt->pParams->sio.moduleNum == 0)
1155         hEdma = hEdma0;
1156     else if (pDevExt->pParams->sio.moduleNum == 1 || pDevExt->pParams->sio.moduleNum == 2)
1157         hEdma = hEdma1;
1158     if (pDevExt->activeEdma != EDMA_HINV)
1159         EDMA3_DRV_disableTransfer (hEdma, pDevExt->activeEdma, EDMA3_DRV_TRIG_MODE_EVENT);
1160
1161     // reset queues
1162     while (!Queue_empty(device->todevice)) {
1163        // place oustanding requests onto holding queue
1164        pFrame = (DEV2_Frame *) Queue_dequeue (device->todevice);
1165        Queue_enqueue (Queue_handle(&pDevExt->xferQue), (Queue_Elem *) pFrame);
1166     }
1167
1168     while (!Queue_empty(Queue_handle(&pDevExt->xferQue))) {
1169         // pull frame from holding queue and place on user queue
1170         pFrame = (DEV2_Frame *) Queue_dequeue (Queue_handle(&pDevExt->xferQue));
1171         Queue_enqueue (device->fromdevice, (Queue_Elem *) pFrame);
1172     }
1173
1174
1175     while (!Queue_empty(Queue_handle(&pDevExt->paramQue)))
1176         Queue_dequeue (Queue_handle(&pDevExt->paramQue));
1177
1178     // not running => can use non-atomic functions
1179     for (i=0; i < pDevExt->numEdmaParams; i++)
1180         Queue_enqueue (Queue_handle(&pDevExt->paramQue), (Queue_Elem *) &pDevExt->edmaParams[i]);
1181
1182     // reset counter
1183     pDevExt->numQueued = 0;
1184
1185     Log_info0("SAP_shutdown: After pDevExt->numQueued = 0 ");
1186
1187     //SAP_EDMA_dumpParams(8);
1188     // make sure active is linked to error
1189     EDMA3_DRV_linkChannel (hEdma, pDevExt->activeEdma, pDevExt->errorEdma);
1190
1191     // think this is better (from SIO_idle for standard model )
1192     // refill frame list -- so user needn't call reclaim, which may cause Rx underrun.
1193     while (!Queue_empty(device->fromdevice)) {
1194         /* place oustanding requests onto holding queue */
1195         pFrame = (DEV2_Frame *) Queue_dequeue (device->fromdevice);
1196         Queue_enqueue (Queue_handle(&stream->framelist), (Queue_Elem *) pFrame);
1197     }
1198     Semaphore_reset (pDevExt->sync, 0);
1199
1200     pDevExt->shutDown = 1;
1201     pDevExt->numParamSetup = 0;
1202
1203     return SIO2_OK;
1204 } // SAP_shutdown
1205
1206 // -----------------------------------------------------------------------------
1207 int gSapWatchDogThrottle = 0;
1208 int gSapWatchDogIn =0;
1209 int gSapWatchDogOut = 0;
1210 int gSapWatchDogInSemPost = 0;
1211 int gSapWatchDogOutSemPost = 0;
1212
1213 Void SAP_watchDog (Void)
1214 {
1215     DEV2_Handle device;
1216     SAP_DeviceExtension *pDevExt;
1217     int i, oldMask, result;
1218
1219     //Log_info2("SAP_watchDog.%d (0x%x)", __LINE__, device);
1220
1221     // do nothing if SAP_init not yet called
1222     if (!SAP_initialized)
1223     {
1224         Log_info2("%s.%d: SAP_init not yet called.\n", (xdc_IArg)__FUNCTION__, __LINE__);
1225         return;
1226     }
1227
1228     // protect context
1229     Task_disable (); // needed since we may call SEM_post
1230     //oldMask = Hwi_disable ();
1231
1232
1233     //Log_info3("%s.%d: devices loop, numDevices = %d", __FUNCTION__, __LINE__, sapDrv.numDevices);
1234
1235     for (i=0; i < sapDrv.numDevices; i++) {
1236         device  = sapDrv.device[i];
1237
1238         //Log_info3("%s.%d, devices loop start, device = 0x%x", __FUNCTION__, __LINE__, device);
1239
1240         pDevExt = (SAP_DeviceExtension *) device->object;
1241
1242         // do nothing if not running
1243         if (!pDevExt->runState)
1244             continue;
1245
1246         // call board specific watchdog
1247         // TODO: handle return value
1248         SIO2_ctrl (device, PAF_SIO_CONTROL_WATCHDOG, NULL);
1249
1250         // if port layer returns error then must need to clean up
1251         result = SAP_PORT_FTABLE_watchDog (device);
1252         if (result) {
1253             // set errorState which will force owner thread
1254             //   to clean up via SIO_idle()
1255             pDevExt->errorState = PAF_SIO_ERROR_FATAL;
1256             if(device->mode == DEV2_INPUT)
1257                 gSapWatchDogIn++;
1258             else
1259                 gSapWatchDogOut++;
1260
1261             //TRACE_TERSE((&TR_MOD, "SAP_watchDog.%d, PAF_SIO_ERROR_FATAL: 0x%x", __LINE__, pDevExt->errorState));
1262
1263             // if outstanding pend then post to free owner thead
1264             if (!Semaphore_pend(pDevExt->sync, 0))
1265             {
1266                 if(device->mode == DEV2_INPUT)
1267                         gSapWatchDogInSemPost++;
1268                 else
1269                         gSapWatchDogOutSemPost++;
1270                 Semaphore_post (pDevExt->sync);
1271             }
1272         }
1273     }
1274
1275
1276     // renable interrupts and task manager.
1277     // If we posted to the semaphore then the TSK_enable call will lead to
1278     // an immediate task switch to the associated audio thread.
1279     //Hwi_restore (oldMask);
1280     Task_enable ();
1281
1282 } // SAP_watchDog
1283
1284 // -----------------------------------------------------------------------------
1285 // Assumes that EDMA3 dispatcher handles TCC clearing.
1286
1287 void SAP_isrCallback (Uint32 tcc, EDMA3_RM_TccStatus status, Ptr context)
1288 {
1289     DEV2_Handle                 device;
1290     SAP_DeviceExtension       *pDevExt;
1291     DEV2_Frame                 *pFrame;
1292     unsigned int               opt;
1293     EDMA3_DRV_Handle                    hEdma;
1294
1295     // could be here after Tx idle/overrun and this is the interrupt
1296     // for the last occuring error transfer so there is no transfer
1297     // to release, we just clear the int and exit.
1298
1299     device = (DEV2_Handle) context;
1300     pDevExt = (SAP_DeviceExtension *)(device->object);
1301     //if (pDevExt->pParams == NULL)
1302         //return SIO2_EINVAL;
1303
1304     if (pDevExt->pParams->sio.moduleNum == 0)
1305         hEdma = hEdma0;
1306     else if (pDevExt->pParams->sio.moduleNum == 1 || pDevExt->pParams->sio.moduleNum == 2)
1307         hEdma = hEdma1;
1308
1309     if ((pDevExt->runState == 1) && !pDevExt->errorState) {
1310         // if here then an interrupt occured due to errorEdma or valid
1311         // transfer, we assume the xfer is long enough so it will not complete
1312         // before we are finished here.
1313
1314         // if last transfer was valid then complete it
1315         if (!Queue_empty(Queue_handle(&pDevExt->xferQue))) {
1316
1317             // pull frame from holding queue
1318             pFrame = (DEV2_Frame *) Queue_dequeue (Queue_handle(&pDevExt->xferQue));
1319
1320             // if used param entry then return it to queue
1321             if (pFrame->misc != NULL)
1322             {
1323                 Queue_enqueue (Queue_handle(&pDevExt->paramQue), (Ptr) pFrame->misc);
1324                 if (device->mode == 1)
1325                         gisrOutput+=100;
1326             }
1327
1328             // decrement count
1329             pDevExt->numQueued -= 1;
1330             //gIsrCnt++;
1331             if (device->mode == 1)
1332                 {
1333                 gIsrOutputCnt++;
1334                 //Log_info1("SAP isrCallback for 0x%x", pDevExt->activeEdma);
1335                 }
1336             else
1337                 gIsrInputCnt++;
1338             // place frame onto user queue and signal user thread
1339             Queue_enqueue (device->fromdevice, (Ptr) pFrame);
1340
1341             //Log_info2("Before SEM_post for device: 0x%x gIsrOutput: %d", device->mode, gisrOutput);
1342             // signal user thread
1343             Semaphore_post (pDevExt->sync);
1344         }
1345         else
1346                 gIsrElseCnt++;
1347
1348         // determine if currently transferring buffer is valid based on interrupt enable bit
1349         // only valid transfers will generate interrupts
1350         EDMA3_DRV_getPaRAMEntry (hEdma, pDevExt->activeEdma, EDMA3_DRV_PARAM_ENTRY_OPT, &opt);
1351
1352         if (!(opt & EDMA3_DRV_OPT_TCINTEN_SET_MASK (1)))
1353         {
1354                 if (device->mode == 1)
1355                         gIsrOutErrCnt++;
1356                 else
1357                         gIsrInErrCnt++;
1358                 pDevExt->errorState = PAF_SIO_ERROR_ERRBUF_XFER;
1359         }
1360
1361     } // runState
1362     else
1363     {
1364                 if (pDevExt->runState != 1)
1365                         gIsrRunCnt++;
1366                 else
1367                         gIsrNotRunCnt++;
1368     }
1369
1370     return;
1371 } //SAP_isrCallback
1372
1373 // -----------------------------------------------------------------------------
1374
1375 Int SAP_EDMA_setupXfer (DEV2_Handle device, XDAS_UInt32 targetEdma, XDAS_UInt32 parentEdma, XDAS_UInt32 childEdma, DEV2_Frame *pFrame)
1376 {
1377     EDMA3_DRV_Handle            hEdma;
1378     SAP_DeviceExtension *pDevExt = (SAP_DeviceExtension *)device->object;
1379 //     int mcbspNum = pDevExt->pParams->sio.moduleNum;
1380
1381         if (pDevExt->pParams == NULL)
1382                 return SIO2_EINVAL;
1383
1384             if (pDevExt->pParams->sio.moduleNum == 0)
1385                 hEdma = hEdma0;
1386             else if (pDevExt->pParams->sio.moduleNum == 1 || pDevExt->pParams->sio.moduleNum == 2)
1387                 hEdma = hEdma1;
1388
1389     // TODO: shouldn't this just be tcc interrupt disable?
1390     // at least until linkage phase...
1391     unsigned int key = Hwi_disable ();
1392
1393     if(targetEdma == NULL)
1394     {
1395         Log_info0("targetEdma is NULL");
1396     }
1397     // configure transfer
1398     if(pFrame->addr == NULL)
1399     {
1400         Log_info0("pFrame has NULL address?");
1401     }
1402     SAP_DMA_FTABLE_setupParam (device, targetEdma, childEdma, (XDAS_UInt32) pFrame->addr, pFrame->size);
1403
1404     if (device->mode == DEV2_OUTPUT)
1405         Log_info4("SAP: Inside SAP_EDMA_setupXfer with childEdma=0x%x & targetEdma = 0x%x; pFrame->addr = 0x%x, pFrame->size=0x%x", childEdma, targetEdma, (xdc_IArg)pFrame->addr, pFrame->size);
1406
1407     if (parentEdma != EDMA_HINV)
1408         EDMA3_DRV_linkChannel (hEdma, parentEdma, targetEdma);
1409
1410     if (device->mode == DEV2_OUTPUT)
1411                 Log_info3("SAP: Inside SAP_EDMA_setupXfer linked targetEdma = 0x%x with parentEdma=0x%x on Edma=0x%x", targetEdma, parentEdma, (xdc_IArg)hEdma);
1412
1413     Hwi_restore (key);
1414
1415     return SIO2_OK;
1416 } // SAP_setupXfer
1417
1418 // -----------------------------------------------------------------------------
1419 // Configure EDMA3 parameter entry
1420
1421 Int SAP_EDMA_setupParam (DEV2_Handle device, XDAS_UInt32 targetEdma, XDAS_UInt32 childEdma, XDAS_UInt32 addr, XDAS_UInt32 size)
1422 {
1423     SAP_DeviceExtension *pDevExt = (SAP_DeviceExtension *)device->object;
1424     EDMA3_DRV_Handle            hEdma;
1425     EDMA3_DRV_PaRAMRegs  edmaConfig;
1426
1427     if (pDevExt->pParams == NULL)
1428                 return SIO2_EINVAL;
1429
1430         if (pDevExt->pParams->sio.moduleNum == 0)
1431                 hEdma = hEdma0;
1432         else if (pDevExt->pParams->sio.moduleNum == 1 || pDevExt->pParams->sio.moduleNum == 2)
1433                 hEdma = hEdma1;
1434     MCASP_Handle hPort = sapMcaspDrv.hPort[pDevExt->pParams->sio.moduleNum];
1435    // volatile Uint32 *base = (volatile Uint32 *)(hPort->baseAddr);
1436
1437    //Log_info3("%s.%d: Entered SAP_EDMA_setupParam for Target: 0x%x.\n", (xdc_IArg)__FUNCTION__, __LINE__, targetEdma);
1438
1439     // Init opt parameter to 0 which, without being overriden, configures as:
1440     //    AB synchronized transfer
1441     //    no chaining or intermediate interrupts
1442     //    param is not static
1443     //    normal completion
1444     //    don't generate an interrupt (overriden below for regular xfers)
1445     edmaConfig.opt = 0;
1446
1447     // not transferring blocks so c index is 0
1448     edmaConfig.destCIdx = 0;
1449     edmaConfig.srcCIdx = 0;
1450
1451     edmaConfig.opt |= EDMA3_DRV_OPT_SYNCDIM_SET_MASK (EDMA3_DRV_SYNC_AB);
1452     if (device->mode == DEV2_OUTPUT)
1453         edmaConfig.opt |= 2;            //DAM=CONST addr mode
1454     else
1455         edmaConfig.opt |= 1;            //SAM=CONST addr mode
1456
1457     // if regular transfer then enable interrupt with tcc code
1458     if (targetEdma != pDevExt->errorEdma) {
1459         edmaConfig.opt |= EDMA3_DRV_OPT_SYNCDIM_SET_MASK (EDMA3_DRV_SYNC_AB);
1460         edmaConfig.opt |= EDMA3_DRV_OPT_TCINTEN_SET_MASK (1);
1461         edmaConfig.opt |= EDMA3_DRV_OPT_TCC_SET_MASK (pDevExt->firstTCC);
1462     }
1463
1464
1465     edmaConfig.aCnt = 4;
1466         edmaConfig.bCnt = pDevExt->numSers;
1467         edmaConfig.cCnt = size/(edmaConfig.aCnt * edmaConfig.bCnt);
1468     edmaConfig.bCntReload = edmaConfig.bCnt;
1469
1470
1471     // handle direction specific requirements
1472     if (device->mode == DEV2_INPUT) {
1473         edmaConfig.srcBIdx  = 0;
1474                 edmaConfig.srcAddr  = (unsigned int) (hPort->rbufAddr);
1475
1476         if (addr) {
1477             edmaConfig.destBIdx = pDevExt->edmaWordSize;
1478             edmaConfig.destAddr = addr;
1479             edmaConfig.destCIdx  = pDevExt->edmaWordSize * pDevExt->numSers ;
1480             if(pDevExt->edmaWordSize == 2)
1481                 edmaConfig.cCnt= (size)/((edmaConfig.aCnt * edmaConfig.bCnt)/2);
1482         }
1483         else {
1484             edmaConfig.destBIdx = 0;
1485             edmaConfig.destAddr = (unsigned int) &sap_OVER_4LANE;
1486             edmaConfig.cCnt = 1;
1487         }
1488     }
1489     else {
1490         edmaConfig.destBIdx = 0;
1491         edmaConfig.srcBIdx  = pDevExt->edmaWordSize;
1492         edmaConfig.destAddr = (unsigned int) (hPort->xbufAddr);
1493         if (addr) {
1494             edmaConfig.srcCIdx  = pDevExt->edmaWordSize * pDevExt->numSers ;
1495             edmaConfig.srcAddr  = addr;
1496         }
1497         else {
1498             edmaConfig.srcBIdx  = 0;
1499             edmaConfig.srcAddr  = (unsigned int) &sap_UNDER[0];
1500         }
1501     }
1502     edmaConfig.srcAddr  = (unsigned int) getGlobalAddr(edmaConfig.srcAddr);
1503     edmaConfig.destAddr  = (unsigned int) getGlobalAddr(edmaConfig.destAddr);
1504
1505     EDMA3_DRV_setPaRAM (hEdma, targetEdma, &edmaConfig);
1506
1507     // link child xfer
1508     if (childEdma != EDMA_HINV)
1509         EDMA3_DRV_linkChannel (hEdma, targetEdma, childEdma);
1510
1511     if (device->mode == DEV2_OUTPUT) {
1512         Log_info5("SAP: Inside SAP_EDMA_setupParam: size=0x%x, targetEdma = 0x%x, CCNT = %d with dest-addr: 0x%x and OPT=0x%x", size, targetEdma, edmaConfig.cCnt, edmaConfig.destAddr, edmaConfig.opt);
1513         Log_info5("SAP: Inside SAP_EDMA_setupParam: aCnt=0x%x, bCnt = 0x%x; linked targetEdma = 0x%x with childEdma=0x%x on Edma=0x%x", edmaConfig.aCnt, edmaConfig.bCnt, targetEdma, childEdma, (xdc_IArg)hEdma );
1514         }
1515
1516     return SIO2_OK;
1517 } //SAP_setupParam