44 lines
726 B
Plaintext
44 lines
726 B
Plaintext
|
|
||
|
|
#include <Spi.h>
|
||
|
|
|
||
|
|
#define X0 0x32
|
||
|
|
#define X1 0x33
|
||
|
|
#define Y0 0x34
|
||
|
|
#define Y1 0x35
|
||
|
|
#define Z0 0x36
|
||
|
|
#define Z1 0x37
|
||
|
|
|
||
|
|
byte data=0;
|
||
|
|
byte ret=0x0A;
|
||
|
|
void setup()
|
||
|
|
{
|
||
|
|
Serial.begin(19200); // start serial for output
|
||
|
|
SPI();
|
||
|
|
Spi.mode(0);
|
||
|
|
Spi.transfer(0x2D,ret);
|
||
|
|
Spi.transfer(0x31,ret);
|
||
|
|
}
|
||
|
|
|
||
|
|
void loop()
|
||
|
|
{
|
||
|
|
|
||
|
|
Serial.print("X=");
|
||
|
|
data=Spi.transfer(0x80||X0,ret);
|
||
|
|
data=data+(Spi.transfer(0x80||X1)<<8,ret);
|
||
|
|
Serial.print(data,DEC);
|
||
|
|
Serial.print(' ');
|
||
|
|
Serial.print("Y=");
|
||
|
|
data=Spi.transfer(0x80||Y0,ret);
|
||
|
|
data=data+(Spi.transfer(0x80||Y1)<<8,ret);
|
||
|
|
Serial.print(data,DEC);
|
||
|
|
Serial.print(' ');
|
||
|
|
Serial.print("Z=");
|
||
|
|
data=Spi.transfer(0x80||Z0,ret);
|
||
|
|
data=data+(Spi.transfer(0x80||Z1)<<8,ret);
|
||
|
|
Serial.print(data,DEC);
|
||
|
|
Serial.println();
|
||
|
|
delay(300);
|
||
|
|
|
||
|
|
}
|
||
|
|
|