lxk.rar_LXK_dsp hpi_hpi

/************************************************************************** Copyright 2002-2007 TGL Ltd. All rights reserved c5416Interface.c -- the source file for c5416Interface DESCRIPTION modification history -------------------- 2007-10-24, Lixiaoke, v1.0 initial version -------------------- **************************************************************************/ #include <semLib.h> #include "c5416hpi.h" #include "c5416DataBuff.h" #include "c5416Interface.h" static const char MCU_READ_FROM_DSP_TASK_NAME[ ] = "RecvTask"; static const char MCU_WRITE_TO_DSP_TASK_NAME[ ] = "SendTask"; static int giTaskMcuReadDspHandle = -1; static int giTaskMcuWriteDspHandle = -1; static unsigned int giMcuWriteDspAddr = 0x00000100; static unsigned int giMcuReadFromDspAddr = 0x00000180; static SEM_ID gsemInterruptId = NULL; static SEM_ID gsemMutexId = NULL; static void InterMcuRecvDataISR( void ) { int lockKey = intLock(); semGive( gsemInterruptId ); intUnlock( lockKey ); } static int taskMcuRecvData( void ) { unsigned short pusStartCodBuf[ 2 ] = { 0x0001, 0x0101 }; unsigned short pusRecvDataBuf[ 7 ] = { }; unsigned short usMcuReadFlag = 0x0000; if( semTake( gsemMutexId, WAIT_FOREVER ) == ERROR ) { printf( "[ taskMcuRecvData ] : semTake gsemMutexId error!\n" ); interTransDInit(); return( 0 ); } hpiWriteDatasAtAddr( giMcuWriteDspAddr, ( unsigned short * )pusStartCodBuf, 2 );/*send the command of start coding*/ if( semGive( gsemMutexId ) == ERROR ) { printf( "[ taskMcuRecvData ] : semGive gsemMutexId error!\n" ); interTransDInit(); return( 0 ); } while( giTaskMcuReadDspHandle != -1 ) { if( semTake( gsemInterruptId, WAIT_FOREVER ) == ERROR ) { printf( "[ taskMcuRecvData ] : semTake gsemInterruptId error!\n" ); interTransDInit(); return( 0 ); } if( semTake( gsemMutexId, WAIT_FOREVER ) == ERROR ) { printf( "[ taskMcuRecvData ] : semTake gsemMutexId error!\n" ); interTransDInit(); return( 0 ); } hpiReadDatasAtAddr( giMcuReadFromDspAddr, ( unsigned short * )pusRecvDataBuf, 7 ); hpiWriteDatasAtAddr( giMcuReadFromDspAddr, ( unsigned short * )( &usMcuReadFlag ), 1 ); if( semGive( gsemMutexId ) == ERROR ) { printf( "[ taskMcuRecvData ] : semGive gsemMutexId error!\n" ); interTransDInit(); return( 0 ); } if( *( unsigned short * )pusRecvDataBuf != 0x0001 ) { continue; } if( *( ( unsigned short * )pusRecvDataBuf + 1 ) != 0x8401 ) { continue; } if( *( ( unsigned short * )pusRecvDataBuf + 2 ) != 0x0004 ) { continue; } printf( "\nRecv : %d_%d_%d_%d_%d_%d_%d\n", pusRecvDataBuf[ 0 ], pusRecvDataBuf[ 1 ], pusRecvDataBuf[ 2 ], pusRecvDataBuf[ 3 ], pusRecvDataBuf[ 4 ], pusRecvDataBuf[ 5 ], pusRecvDataBuf[ 6 ] ); if( c5416WriteDataToRecvBuf( ( unsigned short * )pusRecvDataBuf, sizeof( pusRecvDataBuf ) ) == 0 ) { printf( "[ taskMcuRecvData ] : c5416WriteDataToRecvBuf error!\n" ); interTransDInit(); return( 0 ); } } } static int taskMcuSendData( void ) { unsigned short pusSendDataBuf[ 7 ] = { }; unsigned short pusDspReadFlag; unsigned short iCount; while( giTaskMcuWriteDspHandle != -1 ) { if( c5416ReadDataFromSendBuf( ( unsigned short * )pusSendDataBuf, sizeof( pusSendDataBuf ) ) == 0 ) { printf( "[ taskMcuSendData ] : c5416ReadDataFromSendBuf error!\n" ); interTransDInit(); return( 0 ); } if( *( unsigned short * )pusSendDataBuf != 0x0001 ) { continue; } if( *( ( unsigned short * )pusSendDataBuf + 1 ) != 0x8401 ) { continue; } if( *( ( unsigned short * )pusSendDataBuf + 2 ) != 0x0004 ) { continue; } printf( "\nSend : %d_%d_%d_%d_%d_%d_%d\n", pusSendDataBuf[ 0 ], pusSendDataBuf[ 1 ], pusSendDataBuf[ 2 ], pusSendDataBuf[ 3 ], pusSendDataBuf[ 4 ], pusSendDataBuf[ 5 ], pusSendDataBuf[ 6 ] ); *( unsigned short * )pusSendDataBuf = 0x0001; *( ( unsigned short * )pusSendDataBuf + 1 ) = 0x0801; *( ( unsigned short * )pusSendDataBuf + 2 ) = 0x0004; if( semTake( gsemMutexId, WAIT_FOREVER ) == ERROR ) { printf( "[ taskMcuSendData ] : semTake gsemMutexBuf error!\n" ); interTransDInit(); return( 0 ); } for( iCount = 0; iCount < 4; iCount ++ ) { hpiReadDatasAtAddr( giMcuWriteDspAddr, ( unsigned short * )( &pusDspReadFlag ), 1 ); if( pusDspReadFlag == 0x00 ) { break; } if( iCount < 3 ) { taskDelay( 10 ); } } if( pusDspReadFlag != 0x00 ) { printf( "[ taskMcuSendData ] : Dsp not read data caused error!\n" ); interTransDInit(); return( 0 ); } hpiWriteDatasAtAddr( giMcuWriteDspAddr, ( unsigned short * )pusSendDataBuf, 7 ); if( semGive( gsemMutexId ) == ERROR ) { printf( "[ taskMcuSendData ] : semGive gsemMutexId error!\n" ); interTransDInit(); return( 0 ); } } } int interTransInit( void ) { hpiResetDsp(); if( hpiLoadDsp( "codec.out" ) == 0 ) { printf("[ interTransInit ] : load DSP error!\n"); interTransDInit(); return( 0 ); } if( gsemInterruptId == NULL ) { if( ( gsemInterruptId = semBCreate( SEM_EMPTY, SEM_Q_FIFO ) ) == NULL ) { printf( "[ interTransInit ] : create binary semphore gsemInterruptId error!\n" ); interTransDInit(); return( 0 ); } } if( gsemMutexId == NULL ) { if( ( gsemMutexId = semMCreate( SEM_Q_FIFO ) ) == NULL ) { printf( "[ interTransInit ] : create mutex semaphore gsemMutexId error!\n" ); interTransDInit(); return( 0 ); } } if( giTaskMcuReadDspHandle == -1 ) { if( ( giTaskMcuReadDspHandle =taskSpawn( ( char * )MCU_READ_FROM_DSP_TASK_NAME, 120, 0, 10240, ( FUNCPTR )taskMcuRecvData, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 ) ) == ERROR ) { printf( "[ interTransInit ] : initialize task \"%s\" error!\n", MCU_READ_FROM_DSP_TASK_NAME ); interTransDInit(); return( 0 ); } } if( giTaskMcuWriteDspHandle == -1 ) { if( ( giTaskMcuWriteDspHandle =taskSpawn( ( char * )MCU_WRITE_TO_DSP_TASK_NAME, 121, 0, 10240, ( FUNCPTR )taskMcuSendData, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 ) ) == ERROR ) { printf( "[ interTransInit ] : initialize task \"%s\" error!\n", MCU_WRITE_TO_DSP_TASK_NAME ); interTransDInit(); return( 0 ); } } if( hpiInterruptConnect( InterMcuRecvDataISR ) == 0 ) { printf("[ interTransInit ] : connect to ISR error!\n"); interTransDInit(); return( 0 ); } return( 1 ); }