1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31
|
int *xp, *yp, *zp ;
xp = &X[0] ;
yp = &Y[0] ;
zp = &Z[0] ;
for(i=0; i< NbrAcc; i=i+2){
*xp = spi_transfer(0x00)<<8; //X_MSB byte
*xp |= spi_transfer(0x00); //X_LSB byte
*yp = spi_transfer(0x00)<<8; //Y_MSB byte
*yp |= spi_transfer(0x00); //Y_LSB byte
*zp = spi_transfer(0x00)<<8; //Z_MSB byte
*zp |= spi_transfer(0x00); //Z_LSB byte
buffer_writeDouble(*xp); //Store data 1/2 to buffer
buffer_writeDouble(*yp);
buffer_writeDouble(*zp);
xp++ ; yp++ ; zp++ ;
*xp = spi_transfer(0x00)<<8; //X_MSB byte
*xp |= spi_transfer(0x00); //X_LSB byte
*yp = spi_transfer(0x00)<<8; //Y_MSB byte
*yp |= spi_transfer(0x00); //Y_LSB byte
*zp = spi_transfer(0x00)<<8; //Z_MSB byte
*zp |= spi_transfer(0x00); //Z_LSB byte
xp++ ; yp++ ; zp++ ;
}
} |
Partager