| 1 |
/*=========================================================================== |
| 2 |
FILE: |
| 3 |
Gobi3000Translation.cpp |
| 4 |
|
| 5 |
DESCRIPTION: |
| 6 |
QUALCOMM Translation for Gobi 3000 |
| 7 |
|
| 8 |
Copyright (c) 2011, Code Aurora Forum. All rights reserved. |
| 9 |
|
| 10 |
Redistribution and use in source and binary forms, with or without |
| 11 |
modification, are permitted provided that the following conditions are met: |
| 12 |
* Redistributions of source code must retain the above copyright |
| 13 |
notice, this list of conditions and the following disclaimer. |
| 14 |
* Redistributions in binary form must reproduce the above copyright |
| 15 |
notice, this list of conditions and the following disclaimer in the |
| 16 |
documentation and/or other materials provided with the distribution. |
| 17 |
* Neither the name of Code Aurora Forum nor |
| 18 |
the names of its contributors may be used to endorse or promote |
| 19 |
products derived from this software without specific prior written |
| 20 |
permission. |
| 21 |
|
| 22 |
|
| 23 |
THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" |
| 24 |
AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE |
| 25 |
IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE |
| 26 |
ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE |
| 27 |
LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR |
| 28 |
CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF |
| 29 |
SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS |
| 30 |
INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN |
| 31 |
CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) |
| 32 |
ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE |
| 33 |
POSSIBILITY OF SUCH DAMAGE. |
| 34 |
==========================================================================*/ |
| 35 |
|
| 36 |
//--------------------------------------------------------------------------- |
| 37 |
// Include Files |
| 38 |
//--------------------------------------------------------------------------- |
| 39 |
#include "Gobi3000Translation.h" |
| 40 |
|
| 41 |
/*=========================================================================*/ |
| 42 |
// Free Methods |
| 43 |
/*=========================================================================*/ |
| 44 |
|
| 45 |
/*=========================================================================== |
| 46 |
METHOD: |
| 47 |
GetTLV |
| 48 |
|
| 49 |
DESCRIPTION: |
| 50 |
Return the starting location and size of TLV buffer. |
| 51 |
|
| 52 |
NOTE: does not include the TLV header |
| 53 |
|
| 54 |
PARAMETERS: |
| 55 |
inLen [ I ] - Length of input buffer |
| 56 |
pIn [ I ] - Input buffer |
| 57 |
type [ I ] - Type ID |
| 58 |
pOutLen [ O ] - Length of the output buffer |
| 59 |
ppOut [ O ] - Pointer to output buffer |
| 60 |
|
| 61 |
RETURN VALUE: |
| 62 |
ULONG - Return code |
| 63 |
===========================================================================*/ |
| 64 |
ULONG GetTLV( |
| 65 |
ULONG inLen, |
| 66 |
const BYTE * pIn, |
| 67 |
BYTE typeID, |
| 68 |
ULONG * pOutLen, |
| 69 |
const BYTE ** ppOut ) |
| 70 |
{ |
| 71 |
if (pIn == 0 || pOutLen == 0 || ppOut == 0) |
| 72 |
{ |
| 73 |
return eGOBI_ERR_INVALID_ARG; |
| 74 |
} |
| 75 |
|
| 76 |
for (ULONG offset = 0; |
| 77 |
offset + sizeof( sQMIRawContentHeader ) <= inLen; |
| 78 |
offset += sizeof( sQMIRawContentHeader )) |
| 79 |
{ |
| 80 |
sQMIRawContentHeader * pHeader = (sQMIRawContentHeader*)(pIn + offset); |
| 81 |
|
| 82 |
// Is it big enough to contain this TLV? |
| 83 |
if (offset + sizeof( sQMIRawContentHeader ) + pHeader->mLength > inLen) |
| 84 |
{ |
| 85 |
return eGOBI_ERR_MALFORMED_RSP; |
| 86 |
} |
| 87 |
|
| 88 |
if (pHeader->mTypeID == typeID) |
| 89 |
{ |
| 90 |
*pOutLen = pHeader->mLength; |
| 91 |
*ppOut = pIn + offset + sizeof( sQMIRawContentHeader ); |
| 92 |
|
| 93 |
return eGOBI_ERR_NONE; |
| 94 |
} |
| 95 |
|
| 96 |
offset += pHeader->mLength; |
| 97 |
} |
| 98 |
|
| 99 |
// TLV not found |
| 100 |
return eGOBI_ERR_INVALID_RSP; |
| 101 |
} |