[Feature]Upload Modem source code
Change-Id: Id4294f30faced84d3e6fd6d5e61e1111bf287a37
diff --git a/mcu/driver/audio/src/v1/streamrb.c b/mcu/driver/audio/src/v1/streamrb.c
new file mode 100644
index 0000000..bfaf84b
--- /dev/null
+++ b/mcu/driver/audio/src/v1/streamrb.c
@@ -0,0 +1,488 @@
+/*****************************************************************************
+* Copyright Statement:
+* --------------------
+* This software is protected by Copyright and the information contained
+* herein is confidential. The software may not be copied and the information
+* contained herein may not be used or disclosed except with the written
+* permission of MediaTek Inc. (C) 2005
+*
+* BY OPENING THIS FILE, BUYER HEREBY UNEQUIVOCALLY ACKNOWLEDGES AND AGREES
+* THAT THE SOFTWARE/FIRMWARE AND ITS DOCUMENTATIONS ("MEDIATEK SOFTWARE")
+* RECEIVED FROM MEDIATEK AND/OR ITS REPRESENTATIVES ARE PROVIDED TO BUYER ON
+* AN "AS-IS" BASIS ONLY. MEDIATEK EXPRESSLY DISCLAIMS ANY AND ALL WARRANTIES,
+* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE IMPLIED WARRANTIES OF
+* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE OR NONINFRINGEMENT.
+* NEITHER DOES MEDIATEK PROVIDE ANY WARRANTY WHATSOEVER WITH RESPECT TO THE
+* SOFTWARE OF ANY THIRD PARTY WHICH MAY BE USED BY, INCORPORATED IN, OR
+* SUPPLIED WITH THE MEDIATEK SOFTWARE, AND BUYER AGREES TO LOOK ONLY TO SUCH
+* THIRD PARTY FOR ANY WARRANTY CLAIM RELATING THERETO. MEDIATEK SHALL ALSO
+* NOT BE RESPONSIBLE FOR ANY MEDIATEK SOFTWARE RELEASES MADE TO BUYER'S
+* SPECIFICATION OR TO CONFORM TO A PARTICULAR STANDARD OR OPEN FORUM.
+*
+* BUYER'S SOLE AND EXCLUSIVE REMEDY AND MEDIATEK'S ENTIRE AND CUMULATIVE
+* LIABILITY WITH RESPECT TO THE MEDIATEK SOFTWARE RELEASED HEREUNDER WILL BE,
+* AT MEDIATEK'S OPTION, TO REVISE OR REPLACE THE MEDIATEK SOFTWARE AT ISSUE,
+* OR REFUND ANY SOFTWARE LICENSE FEES OR SERVICE CHARGE PAID BY BUYER TO
+* MEDIATEK FOR SUCH MEDIATEK SOFTWARE AT ISSUE.
+*
+* THE TRANSACTION CONTEMPLATED HEREUNDER SHALL BE CONSTRUED IN ACCORDANCE
+* WITH THE LAWS OF THE STATE OF CALIFORNIA, USA, EXCLUDING ITS CONFLICT OF
+* LAWS PRINCIPLES. ANY DISPUTES, CONTROVERSIES OR CLAIMS ARISING THEREOF AND
+* RELATED THERETO SHALL BE SETTLED BY ARBITRATION IN SAN FRANCISCO, CA, UNDER
+* THE RULES OF THE INTERNATIONAL CHAMBER OF COMMERCE (ICC).
+*
+*****************************************************************************/
+
+/*****************************************************************************
+ *
+ * Filename:
+ * ---------
+ * StreamRB.c
+ *
+ * Project:
+ * --------
+ * MOLY_sw
+ *
+ * Description:
+ * ------------
+ * StreamRB interface and driver, providing stream ring buffer utility
+ *
+ * Author:
+ * -------
+ * -------
+ *============================================================================
+ * HISTORY
+ * Below this line, this part is controlled by PVCS VM. DO NOT MODIFY!!
+ *------------------------------------------------------------------------------
+ * removed!
+ * removed!
+ * removed!
+ *
+ * removed!
+ * removed!
+ * removed!
+ *
+ *
+ *
+ *------------------------------------------------------------------------------
+ * Upper this line, this part is controlled by PVCS VM. DO NOT MODIFY!!
+ *============================================================================
+ ****************************************************************************/
+
+/*****************************************************************************
+* C O M P I L E R F L A G S
+******************************************************************************
+*/
+
+/*****************************************************************************
+* E X T E R N A L R E F E R E N C E S
+******************************************************************************
+*/
+#include "kal_public_api.h"
+#include "string.h"
+
+#include "l1aud_common_def.h"
+#include "streamrb.h"
+/*****************************************************************************
+* C O N S T A N T S
+******************************************************************************
+*/
+
+/*****************************************************************************
+* D A T A T Y P E S
+******************************************************************************
+*/
+
+/*****************************************************************************
+* P U B L I C D A T A
+******************************************************************************
+*/
+
+/*****************************************************************************
+* P R I V A T E D A T A
+******************************************************************************
+*/
+
+/*****************************************************************************
+* M A C R O S
+******************************************************************************
+*/
+
+/*****************************************************************************
+* F U N C T I O N D E C L A R A T I O N S
+******************************************************************************
+*/
+
+/*****************************************************************************
+* F U N C T I O N S
+******************************************************************************
+*/
+
+
+/*
+ * Description
+ * ---------
+ * The function initializes the ring buffer instance.
+ *
+ * Syntax
+ * ---------
+ * bool StreamRB_Init( StreamRB *rb, uint8 *buffer, int32 buffer_size )
+ *
+ * where
+ * rb The ring buffer instance
+ * buffer Address of the memory allocated for the ring buffer
+ * buffer_size Size of the memory allocated for the ring buffer
+ *
+ * Return Value
+ * ---------
+ * true
+ * false
+ */
+bool StreamRB_Init( StreamRB *rb, uint8 *buffer, int32 buffer_size )
+{
+ ASSERT( rb!=NULL );
+
+ memset( buffer, 0, buffer_size*sizeof(uint8) );
+ rb->buffer = buffer;
+ rb->size = buffer_size;
+ rb->read = 0;
+ rb->write = 0;
+
+ return true;
+}
+
+
+/*
+ * Description
+ * ---------
+ * The function returns the available free space of the ring buffer instance.
+ *
+ * Syntax
+ * ---------
+ * int32 StreamRB_GetFreeSpace( StreamRB *rb )
+ *
+ * where
+ * rb The ring buffer instance
+ *
+ * Return Value
+ * ---------
+ * the free space in words
+ */
+int32 StreamRB_GetFreeSpace( StreamRB *rb )
+{
+ int32 count;
+
+ ASSERT( rb!=NULL );
+
+ count = rb->read - rb->write - 1;
+ if( 0>count )
+ count += rb->size;
+ return count;
+}
+
+
+/*
+ * Description
+ * ---------
+ * The function returns available data count of the ring buffer instance
+ *
+ * Syntax
+ * ---------
+ * int32 StreamRB_GetDataCount( StreamRB *rb )
+ *
+ * where
+ * rb The ring buffer instance
+ *
+ * Return Value
+ * ---------
+ * the data count in words
+ */
+int32 StreamRB_GetDataCount( StreamRB *rb )
+{
+ int32 count;
+
+ ASSERT( rb!=NULL );
+
+ count = rb->write - rb->read;
+ if( 0>count )
+ count += rb->size;
+ return count;
+}
+
+
+/*
+ * Description
+ * ---------
+ * The function copies data from a linear array to a ring buffer instance.
+ * The free space of the ring buffer instance shall be enough, or assertion will happen
+ *
+ * Syntax
+ * ---------
+ * void StreamRB_Write( StreamRB *dest_rb, uint8 *src_buffer, int32 size )
+ *
+ * where
+ * dest_rb The ring buffer instance
+ * src_buffer Address of the linear array
+ * size Size of copy
+ *
+ * Return Value
+ * ---------
+ * none
+ */
+void StreamRB_Write( StreamRB *dest_rb, uint8 *src_buffer, int32 size )
+{
+ uint8 *write_ptr;
+ int32 write_cnt;
+/// kal_prompt_trace(MOD_L1SP, "StreamRB_Write size=%d",size);
+ ASSERT( dest_rb!=NULL );
+ ASSERT( StreamRB_GetFreeSpace( dest_rb )>=size );
+
+ StreamRB_GetWriteBlock( dest_rb, &write_ptr, &write_cnt );
+ if( write_cnt>size ) write_cnt = size;
+
+ if( src_buffer == (uint8 *)NULL ){
+ memset( write_ptr, 0, write_cnt*sizeof(uint8) );
+/// kal_prompt_trace(MOD_L1SP, "StreamRB_Write Null");
+ }else{
+ memcpy( write_ptr, src_buffer, write_cnt*sizeof(uint8) );
+/// kal_prompt_trace(MOD_L1SP, "StreamRB_Write %x %x %x %x", write_ptr, *(src_buffer+0),*(src_buffer+1),*(src_buffer+2));
+ }
+
+ StreamRB_ShiftWritePointer( dest_rb, write_cnt );
+ size -= write_cnt;
+
+ if( size>0 )
+ {
+ if( src_buffer != (uint8 *)NULL )
+ {
+ src_buffer += write_cnt;
+ }
+
+ StreamRB_GetWriteBlock( dest_rb, &write_ptr, &write_cnt );
+ if( write_cnt>size )
+ {
+ write_cnt = size;
+ }
+
+ if( src_buffer == (uint8 *)NULL )
+ {
+ memset( write_ptr, 0, write_cnt*sizeof(uint8) );
+ }
+ else
+ {
+ memcpy( write_ptr, src_buffer, write_cnt*sizeof(uint8) );
+ }
+
+ StreamRB_ShiftWritePointer( dest_rb, write_cnt );
+ }
+}
+
+
+/*
+ * Description
+ * ---------
+ * The function copies data from a ring buffer instance to a linear array
+ * The data count of the ring buffer instance shall be enough, or assertion will happen
+ *
+ * Syntax
+ * ---------
+ * void StreamRB_Read( StreamRB *src_rb, uint8 *dest_buffer, int32 size )
+ *
+ * where
+ * src_rb The ring buffer instance
+ * dest_buffer Address of the linear array
+ * size Size of copy
+ *
+ * Return Value
+ * ---------
+ * none
+ */
+void StreamRB_Read( StreamRB *src_rb, uint8 *dest_buffer, int32 size )
+{
+ uint8 *read_ptr;
+ int32 read_cnt;
+/// kal_prompt_trace(MOD_L1SP, "StreamRB_Read size=%d",size);
+ ASSERT( src_rb!=NULL );
+ ASSERT( StreamRB_GetDataCount( src_rb )>=size );
+
+ StreamRB_GetReadBlock( src_rb, &read_ptr, &read_cnt );
+ if( read_cnt>size )
+ {
+ read_cnt = size;
+ }
+ memcpy( dest_buffer, read_ptr, read_cnt*sizeof(uint8) );
+ StreamRB_ShiftReadPointer( src_rb, read_cnt );
+ size -= read_cnt;
+
+ if( size>0 )
+ {
+ dest_buffer += read_cnt;
+ StreamRB_GetReadBlock( src_rb, &read_ptr, &read_cnt );
+ if( read_cnt>size )
+ {
+ read_cnt = size;
+ }
+ memcpy( dest_buffer, read_ptr, read_cnt*sizeof(uint8) );
+ StreamRB_ShiftReadPointer( src_rb, read_cnt );
+ }
+}
+
+
+/*void StreamRB_ShiftReadPointer2( StreamRB *src_rb, int32 size )
+{
+ uint8 *read_ptr;
+ int32 read_cnt;
+
+ ASSERT( src_rb!=NULL );
+ ASSERT( StreamRB_GetDataCount( src_rb )>=size );
+
+ StreamRB_GetReadBlock( src_rb, &read_ptr, &read_cnt );
+ if( read_cnt>size )
+ {
+ read_cnt = size;
+ }
+ //memcpy( dest_buffer, read_ptr, read_cnt*sizeof(int16) );
+ StreamRB_ShiftReadPointer( src_rb, read_cnt );
+ size -= read_cnt;
+
+ if( size>0 )
+ {
+ //dest_buffer += read_cnt;
+ StreamRB_GetReadBlock( src_rb, &read_ptr, &read_cnt );
+ if( read_cnt>size )
+ {
+ read_cnt = size;
+ }
+ // memcpy( dest_buffer, read_ptr, read_cnt*sizeof(int16) );
+ StreamRB_ShiftReadPointer( src_rb, read_cnt );
+ }
+}*/
+
+
+/*
+ * Description
+ * ---------
+ * The function returns the linear write block and its size of a ring buffer instance
+ *
+ * Syntax
+ * ---------
+ * void StreamRB_GetWriteBlock( StreamRB *dest_rb, uint8 **write_ptr, int32 *write_cnt )
+ *
+ * where
+ * dest_rb The ring buffer instance
+ * write_ptr Address of the memory to put the address of the linear write block
+ * write_cnt Address of the memory to put the size of the linear write block
+ *
+ * Return Value
+ * ---------
+ * none
+ */
+void StreamRB_GetWriteBlock( StreamRB *dest_rb, uint8 **write_ptr, int32 *write_cnt )
+{
+ int32 cnt;
+
+ ASSERT( (dest_rb!=NULL) && (write_ptr!=NULL) && (write_cnt!=NULL) );
+
+ if( dest_rb->read>dest_rb->write )
+ cnt = dest_rb->read - dest_rb->write - 1;
+ else if( dest_rb->read==0 )
+ cnt = dest_rb->size - dest_rb->write - 1;
+ else
+ cnt = dest_rb->size - dest_rb->write;
+
+ *write_cnt = cnt;
+ *write_ptr = &dest_rb->buffer[dest_rb->write];
+}
+
+
+/*
+ * Description
+ * ---------
+ * The function returns the linear read block and its size of a ring buffer instance
+ *
+ * Syntax
+ * ---------
+ * void StreamRB_GetReadBlock( StreamRB *src_rb, uint8 **read_ptr, int32 *read_cnt )
+ *
+ * where
+ * src_rb The ring buffer instance
+ * read_ptr Address of the memory to put the address of the linear read block
+ * read_cnt Address of the memory to put the size of the linear read block
+ *
+ * Return Value
+ * ---------
+ * none
+ */
+void StreamRB_GetReadBlock( StreamRB *src_rb, uint8 **read_ptr, int32 *read_cnt )
+{
+ int32 cnt;
+
+ ASSERT( (src_rb!=NULL) && (read_ptr!=NULL) && (read_cnt!=NULL) );
+
+ if( src_rb->write == src_rb->read )
+ cnt = 0;
+ else if( src_rb->write>src_rb->read )
+ cnt = src_rb->write - src_rb->read;
+ else
+ cnt = src_rb->size - src_rb->read;
+
+ *read_cnt = cnt;
+ *read_ptr = &src_rb->buffer[src_rb->read];
+}
+
+
+/*
+ * Description
+ * ---------
+ * The function shifts the write pointer of a ring buffer instance in circular way
+ * Use this with StreamRB_GetWriteBlock
+ *
+ * Syntax
+ * ---------
+ * void StreamRB_ShiftWritePointer( StreamRB *rb, int32 shamt )
+ *
+ * where
+ * rb The ring buffer instance
+ * shamt shift amount
+ *
+ * Return Value
+ * ---------
+ * none
+ */
+void StreamRB_ShiftWritePointer( StreamRB *rb, int32 shamt )
+{
+ ASSERT( rb!=NULL );
+
+ rb->write += shamt;
+ if( rb->write>=rb->size )
+ rb->write -= rb->size;
+}
+
+
+/*
+ * Description
+ * ---------
+ * The function shifts the read pointer of a ring buffer instance in circular way
+ * Use this with StreamRB_GetReadBlock
+ *
+ * Syntax
+ * ---------
+ * void StreamRB_ShiftReadPointer( StreamRB *rb, int32 shamt )
+ *
+ * where
+ * rb The ring buffer instance
+ * shamt shift amount
+ *
+ * Return Value
+ * ---------
+ * none
+ */
+void StreamRB_ShiftReadPointer( StreamRB *rb, int32 shamt )
+{
+ ASSERT( rb!=NULL );
+
+ rb->read += shamt;
+ if( rb->read>=rb->size )
+ rb->read -= rb->size;
+}
+