Shinichiro Nakamura / Mbed 2 deprecated Toragi_2011_05_XsvfPlayer

トランジスタ技術2011年9月号「mbed30分クッキング」のプログラムです。

Dependencies:   mbed TextLCD SDFileSystem

mylib/lenval.c@0:42e9eb506e88, 2011-08-08 (annotated)

Committer:
shintamainjp
Date:
Mon Aug 08 10:33:50 2011 +0000
Revision:
0:42e9eb506e88
Initial version.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
shintamainjp 0:42e9eb506e88 1 /*******************************************************/
shintamainjp 0:42e9eb506e88 2 /* file: lenval.c */
shintamainjp 0:42e9eb506e88 3 /* abstract: This file contains routines for using */
shintamainjp 0:42e9eb506e88 4 /* the lenVal data structure. */
shintamainjp 0:42e9eb506e88 5 /*******************************************************/
shintamainjp 0:42e9eb506e88 6 #include "lenval.h"
shintamainjp 0:42e9eb506e88 7 #include "ports.h"
shintamainjp 0:42e9eb506e88 8
shintamainjp 0:42e9eb506e88 9 /*****************************************************************************
shintamainjp 0:42e9eb506e88 10 * Function: value
shintamainjp 0:42e9eb506e88 11 * Description: Extract the long value from the lenval array.
shintamainjp 0:42e9eb506e88 12 * Parameters: plvValue - ptr to lenval.
shintamainjp 0:42e9eb506e88 13 * Returns: long - the extracted value.
shintamainjp 0:42e9eb506e88 14 *****************************************************************************/
shintamainjp 0:42e9eb506e88 15 long value( lenVal* plvValue )
shintamainjp 0:42e9eb506e88 16 {
shintamainjp 0:42e9eb506e88 17 long lValue; /* result to hold the accumulated result */
shintamainjp 0:42e9eb506e88 18 short sIndex;
shintamainjp 0:42e9eb506e88 19
shintamainjp 0:42e9eb506e88 20 lValue = 0;
shintamainjp 0:42e9eb506e88 21 for ( sIndex = 0; sIndex < plvValue->len ; ++sIndex )
shintamainjp 0:42e9eb506e88 22 {
shintamainjp 0:42e9eb506e88 23 lValue <<= 8; /* shift the accumulated result */
shintamainjp 0:42e9eb506e88 24 lValue |= plvValue->val[ sIndex]; /* get the last byte first */
shintamainjp 0:42e9eb506e88 25 }
shintamainjp 0:42e9eb506e88 26
shintamainjp 0:42e9eb506e88 27 return( lValue );
shintamainjp 0:42e9eb506e88 28 }
shintamainjp 0:42e9eb506e88 29
shintamainjp 0:42e9eb506e88 30 /*****************************************************************************
shintamainjp 0:42e9eb506e88 31 * Function: initLenVal
shintamainjp 0:42e9eb506e88 32 * Description: Initialize the lenval array with the given value.
shintamainjp 0:42e9eb506e88 33 * Assumes lValue is less than 256.
shintamainjp 0:42e9eb506e88 34 * Parameters: plv - ptr to lenval.
shintamainjp 0:42e9eb506e88 35 * lValue - the value to set.
shintamainjp 0:42e9eb506e88 36 * Returns: void.
shintamainjp 0:42e9eb506e88 37 *****************************************************************************/
shintamainjp 0:42e9eb506e88 38 void initLenVal( lenVal* plv,
shintamainjp 0:42e9eb506e88 39 long lValue )
shintamainjp 0:42e9eb506e88 40 {
shintamainjp 0:42e9eb506e88 41 plv->len = 1;
shintamainjp 0:42e9eb506e88 42 plv->val[0] = (unsigned char)lValue;
shintamainjp 0:42e9eb506e88 43 }
shintamainjp 0:42e9eb506e88 44
shintamainjp 0:42e9eb506e88 45 /*****************************************************************************
shintamainjp 0:42e9eb506e88 46 * Function: EqualLenVal
shintamainjp 0:42e9eb506e88 47 * Description: Compare two lenval arrays with an optional mask.
shintamainjp 0:42e9eb506e88 48 * Parameters: plvTdoExpected - ptr to lenval #1.
shintamainjp 0:42e9eb506e88 49 * plvTdoCaptured - ptr to lenval #2.
shintamainjp 0:42e9eb506e88 50 * plvTdoMask - optional ptr to mask (=0 if no mask).
shintamainjp 0:42e9eb506e88 51 * Returns: short - 0 = mismatch; 1 = equal.
shintamainjp 0:42e9eb506e88 52 *****************************************************************************/
shintamainjp 0:42e9eb506e88 53 short EqualLenVal( lenVal* plvTdoExpected,
shintamainjp 0:42e9eb506e88 54 lenVal* plvTdoCaptured,
shintamainjp 0:42e9eb506e88 55 lenVal* plvTdoMask )
shintamainjp 0:42e9eb506e88 56 {
shintamainjp 0:42e9eb506e88 57 short sEqual;
shintamainjp 0:42e9eb506e88 58 short sIndex;
shintamainjp 0:42e9eb506e88 59 unsigned char ucByteVal1;
shintamainjp 0:42e9eb506e88 60 unsigned char ucByteVal2;
shintamainjp 0:42e9eb506e88 61 unsigned char ucByteMask;
shintamainjp 0:42e9eb506e88 62
shintamainjp 0:42e9eb506e88 63 sEqual = 1;
shintamainjp 0:42e9eb506e88 64 sIndex = plvTdoExpected->len;
shintamainjp 0:42e9eb506e88 65
shintamainjp 0:42e9eb506e88 66 while ( sEqual && sIndex-- )
shintamainjp 0:42e9eb506e88 67 {
shintamainjp 0:42e9eb506e88 68 ucByteVal1 = plvTdoExpected->val[ sIndex ];
shintamainjp 0:42e9eb506e88 69 ucByteVal2 = plvTdoCaptured->val[ sIndex ];
shintamainjp 0:42e9eb506e88 70 if ( plvTdoMask )
shintamainjp 0:42e9eb506e88 71 {
shintamainjp 0:42e9eb506e88 72 ucByteMask = plvTdoMask->val[ sIndex ];
shintamainjp 0:42e9eb506e88 73 ucByteVal1 &= ucByteMask;
shintamainjp 0:42e9eb506e88 74 ucByteVal2 &= ucByteMask;
shintamainjp 0:42e9eb506e88 75 }
shintamainjp 0:42e9eb506e88 76 if ( ucByteVal1 != ucByteVal2 )
shintamainjp 0:42e9eb506e88 77 {
shintamainjp 0:42e9eb506e88 78 sEqual = 0;
shintamainjp 0:42e9eb506e88 79 }
shintamainjp 0:42e9eb506e88 80 }
shintamainjp 0:42e9eb506e88 81
shintamainjp 0:42e9eb506e88 82 return( sEqual );
shintamainjp 0:42e9eb506e88 83 }
shintamainjp 0:42e9eb506e88 84
shintamainjp 0:42e9eb506e88 85
shintamainjp 0:42e9eb506e88 86 /*****************************************************************************
shintamainjp 0:42e9eb506e88 87 * Function: RetBit
shintamainjp 0:42e9eb506e88 88 * Description: return the (byte, bit) of lv (reading from left to right).
shintamainjp 0:42e9eb506e88 89 * Parameters: plv - ptr to lenval.
shintamainjp 0:42e9eb506e88 90 * iByte - the byte to get the bit from.
shintamainjp 0:42e9eb506e88 91 * iBit - the bit number (0=msb)
shintamainjp 0:42e9eb506e88 92 * Returns: short - the bit value.
shintamainjp 0:42e9eb506e88 93 *****************************************************************************/
shintamainjp 0:42e9eb506e88 94 short RetBit( lenVal* plv,
shintamainjp 0:42e9eb506e88 95 int iByte,
shintamainjp 0:42e9eb506e88 96 int iBit )
shintamainjp 0:42e9eb506e88 97 {
shintamainjp 0:42e9eb506e88 98 /* assert( ( iByte >= 0 ) && ( iByte < plv->len ) ); */
shintamainjp 0:42e9eb506e88 99 /* assert( ( iBit >= 0 ) && ( iBit < 8 ) ); */
shintamainjp 0:42e9eb506e88 100 return( (short)( ( plv->val[ iByte ] >> ( 7 - iBit ) ) & 0x1 ) );
shintamainjp 0:42e9eb506e88 101 }
shintamainjp 0:42e9eb506e88 102
shintamainjp 0:42e9eb506e88 103 /*****************************************************************************
shintamainjp 0:42e9eb506e88 104 * Function: SetBit
shintamainjp 0:42e9eb506e88 105 * Description: set the (byte, bit) of lv equal to val
shintamainjp 0:42e9eb506e88 106 * Example: SetBit("00000000",byte, 1) equals "01000000".
shintamainjp 0:42e9eb506e88 107 * Parameters: plv - ptr to lenval.
shintamainjp 0:42e9eb506e88 108 * iByte - the byte to get the bit from.
shintamainjp 0:42e9eb506e88 109 * iBit - the bit number (0=msb).
shintamainjp 0:42e9eb506e88 110 * sVal - the bit value to set.
shintamainjp 0:42e9eb506e88 111 * Returns: void.
shintamainjp 0:42e9eb506e88 112 *****************************************************************************/
shintamainjp 0:42e9eb506e88 113 void SetBit( lenVal* plv,
shintamainjp 0:42e9eb506e88 114 int iByte,
shintamainjp 0:42e9eb506e88 115 int iBit,
shintamainjp 0:42e9eb506e88 116 short sVal )
shintamainjp 0:42e9eb506e88 117 {
shintamainjp 0:42e9eb506e88 118 unsigned char ucByteVal;
shintamainjp 0:42e9eb506e88 119 unsigned char ucBitMask;
shintamainjp 0:42e9eb506e88 120
shintamainjp 0:42e9eb506e88 121 ucBitMask = (unsigned char)(1 << ( 7 - iBit ));
shintamainjp 0:42e9eb506e88 122 ucByteVal = (unsigned char)(plv->val[ iByte ] & (~ucBitMask));
shintamainjp 0:42e9eb506e88 123
shintamainjp 0:42e9eb506e88 124 if ( sVal )
shintamainjp 0:42e9eb506e88 125 {
shintamainjp 0:42e9eb506e88 126 ucByteVal |= ucBitMask;
shintamainjp 0:42e9eb506e88 127 }
shintamainjp 0:42e9eb506e88 128 plv->val[ iByte ] = ucByteVal;
shintamainjp 0:42e9eb506e88 129 }
shintamainjp 0:42e9eb506e88 130
shintamainjp 0:42e9eb506e88 131 /*****************************************************************************
shintamainjp 0:42e9eb506e88 132 * Function: AddVal
shintamainjp 0:42e9eb506e88 133 * Description: add val1 to val2 and store in resVal;
shintamainjp 0:42e9eb506e88 134 * assumes val1 and val2 are of equal length.
shintamainjp 0:42e9eb506e88 135 * Parameters: plvResVal - ptr to result.
shintamainjp 0:42e9eb506e88 136 * plvVal1 - ptr of addendum.
shintamainjp 0:42e9eb506e88 137 * plvVal2 - ptr of addendum.
shintamainjp 0:42e9eb506e88 138 * Returns: void.
shintamainjp 0:42e9eb506e88 139 *****************************************************************************/
shintamainjp 0:42e9eb506e88 140 void addVal( lenVal* plvResVal,
shintamainjp 0:42e9eb506e88 141 lenVal* plvVal1,
shintamainjp 0:42e9eb506e88 142 lenVal* plvVal2 )
shintamainjp 0:42e9eb506e88 143 {
shintamainjp 0:42e9eb506e88 144 unsigned char ucCarry;
shintamainjp 0:42e9eb506e88 145 unsigned short usSum;
shintamainjp 0:42e9eb506e88 146 unsigned short usVal1;
shintamainjp 0:42e9eb506e88 147 unsigned short usVal2;
shintamainjp 0:42e9eb506e88 148 short sIndex;
shintamainjp 0:42e9eb506e88 149
shintamainjp 0:42e9eb506e88 150 plvResVal->len = plvVal1->len; /* set up length of result */
shintamainjp 0:42e9eb506e88 151
shintamainjp 0:42e9eb506e88 152 /* start at least significant bit and add bytes */
shintamainjp 0:42e9eb506e88 153 ucCarry = 0;
shintamainjp 0:42e9eb506e88 154 sIndex = plvVal1->len;
shintamainjp 0:42e9eb506e88 155 while ( sIndex-- )
shintamainjp 0:42e9eb506e88 156 {
shintamainjp 0:42e9eb506e88 157 usVal1 = plvVal1->val[ sIndex ]; /* i'th byte of val1 */
shintamainjp 0:42e9eb506e88 158 usVal2 = plvVal2->val[ sIndex ]; /* i'th byte of val2 */
shintamainjp 0:42e9eb506e88 159
shintamainjp 0:42e9eb506e88 160 /* add the two bytes plus carry from previous addition */
shintamainjp 0:42e9eb506e88 161 usSum = (unsigned short)( usVal1 + usVal2 + ucCarry );
shintamainjp 0:42e9eb506e88 162
shintamainjp 0:42e9eb506e88 163 /* set up carry for next byte */
shintamainjp 0:42e9eb506e88 164 ucCarry = (unsigned char)( ( usSum > 255 ) ? 1 : 0 );
shintamainjp 0:42e9eb506e88 165
shintamainjp 0:42e9eb506e88 166 /* set the i'th byte of the result */
shintamainjp 0:42e9eb506e88 167 plvResVal->val[ sIndex ] = (unsigned char)usSum;
shintamainjp 0:42e9eb506e88 168 }
shintamainjp 0:42e9eb506e88 169 }
shintamainjp 0:42e9eb506e88 170
shintamainjp 0:42e9eb506e88 171 /*****************************************************************************
shintamainjp 0:42e9eb506e88 172 * Function: readVal
shintamainjp 0:42e9eb506e88 173 * Description: read from XSVF numBytes bytes of data into x.
shintamainjp 0:42e9eb506e88 174 * Parameters: plv - ptr to lenval in which to put the bytes read.
shintamainjp 0:42e9eb506e88 175 * sNumBytes - the number of bytes to read.
shintamainjp 0:42e9eb506e88 176 * Returns: void.
shintamainjp 0:42e9eb506e88 177 *****************************************************************************/
shintamainjp 0:42e9eb506e88 178 void readVal( lenVal* plv,
shintamainjp 0:42e9eb506e88 179 short sNumBytes )
shintamainjp 0:42e9eb506e88 180 {
shintamainjp 0:42e9eb506e88 181 unsigned char* pucVal;
shintamainjp 0:42e9eb506e88 182
shintamainjp 0:42e9eb506e88 183 plv->len = sNumBytes; /* set the length of the lenVal */
shintamainjp 0:42e9eb506e88 184 for ( pucVal = plv->val; sNumBytes; --sNumBytes, ++pucVal )
shintamainjp 0:42e9eb506e88 185 {
shintamainjp 0:42e9eb506e88 186 /* read a byte of data into the lenVal */
shintamainjp 0:42e9eb506e88 187 readByte( pucVal );
shintamainjp 0:42e9eb506e88 188 }
shintamainjp 0:42e9eb506e88 189 }
shintamainjp 0:42e9eb506e88 190