Pni TCM Bedienungsanleitung PDF herunterladen (Seite 70)

PNI Sensor Corporation DOC#1014688 r06

TCM User Manual – July 2013 Page 65

mOut Dat a[ i ndex++] = count >> 8;

mOut Dat a[ i ndex++] = count & 0xFF;

/ / st or e t he f r ame I D

mOut Dat a[ i ndex++] = f r ameType ;

/ / copy t he dat a t o be sent

whi l e( l en--) mOut Dat a[ i ndex++] = * dat a++;

/ / comput e and add t he cr c

cr c = CRC( mOut Dat a, i ndex) ;

mOut Dat a[ i ndex++] = cr c >> 8 ;

mOut Dat a[ i ndex++] = cr c & 0xFF ;

/ / Wr i t e bl ock wi l l copy and send t he dat a out t he ser i al por t

mSer i al Por t - >Wr i t eBl ock( mOut Dat a, i ndex) ;

}

/ / Cal l t he f unct i ons i n ser i al por t necessar y t o change t he

// baud r at e

voi d CommPr ot ocol : : Set Baud( UI nt 32 baud)

{

mSer i al Por t - >Set BaudRat e( baud) ;

mSer i al Por t - >I nCl ear ( ) ;

/ / cl ear any dat a t hat was al r eady wai t i ng i n t he buf f er

}

/ / Updat e t he CRC f or t r ansmi t t ed and r ecei ved dat a usi ng t he

// CCI TT 16bi t al gor i t hm ( X^16 + X^12 + X^5 + 1) .

UI nt 16 CommPr ot ocol : : CRC( voi d * dat a, UI nt 32 l en)

{

UI nt 8 * dat aPt r = ( UI nt 8 * ) dat a;

UI nt 32 i ndex = 0;

UI nt 16 cr c = 0;

whi l e( l en--)

{

cr c = ( unsi gned char ) ( cr c >> 8) | ( cr c << 8) ;

cr c ^= dat aPt r [ i ndex++] ;

cr c ^= ( unsi gned char ) ( cr c & 0xf f ) >> 4;

cr c ^= ( cr c << 8) << 4;

cr c ^= ( ( cr c & 0xf f ) << 4) << 1;

}

r et ur n cr c;

}

/ / Thi s i s cal l ed each t i me t hi s pr ocess get s a t ur n t o execut e.

voi d CommPr ot ocol : : Cont r ol ( )

{

/ / I nLen r et ur ns t he number of byt es i n t he i nput buf f er of

//t he ser i al obj ect t hat ar e avai l abl e f or us t o r ead.

UI nt 32 i nLen = mSer i al Por t - >I nLen( ) ;

1 2 ... 65 66 67 68 69 70 71 72 73 74 75 76 77

Kommentare zu diesen Handbüchern

Keine Kommentare

Pni TCM Bedienungsanleitung Seite 70

Kommentare zu diesen Handbüchern

Verwandte Produkte und Handbücher für Sensoren Pni TCM