-
Notifications
You must be signed in to change notification settings - Fork 2
/
Copy pathfinal.js
92 lines (59 loc) · 3.73 KB
/
final.js
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
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
var tessel = require('tessel');
// Connect to device
var port = tessel.port.A; // Use the SCL/SDA pins of Port A
//This address of the Slave has been taken from https://github.com/tessel/accel-mma84/blob/master/index.js#L15
var slaveAddress = 0x1D; // Specific to device
var i2c = new port.I2C(slaveAddress); // Initialize I2C communication
// Details of I2C transfer
var numBytesToRead = 1; // Read back this number of bytes
// Read data over I2C using i2c.transfer
i2c.read(numBytesToRead, function (error, dataReceived) {
// Print data received (buffer of hex values)
console.log('Buffer returned by I2C slave device ('+slaveAddress.toString(16)+'):', dataReceived);
});
// Read/Receive data over I2C using i2c.transfer
// 0x0D is the WHO_AM_I Register which sends back an acknowledgement to the master for starting the communication
i2c.transfer(new Buffer([0x0D]), numBytesToRead, function (error, dataReceived) {
// Print data received (buffer of hex values)
// The returned buffer from the I2C slave device should be [0x2A]
console.log('Buffer returned by I2C slave device ('+slaveAddress.toString(16)+'):', dataReceived);
});
/*
In the i2c.transfer function the dataReceived consists of all the 6 bytes of data 2 bytes each for the x, y and z values.
Each of the x, y and z coordinates have two registers associated with them for storing the 12 bit long sample.
The first 8 bits are stored in their respective OUT_MSB registers. These are the Most Significant first 8 bits.
The next 4 bits are stored in their respective OUT_LSB registers. The remaining 4 bits are occupied
by 0s. These lower 4 bits are redundant bits which are not required. The OUT_LSB and OUT_MSB store the 2's complement form of the coordinates.
The organisation of the registers can be seen in the datasheet inside section 6.1 (Data Registers), page number - 21
The register address for OUT_X_MSB is 0x01. This can be found at Page 19 of https://www.nxp.com/docs/en/data-sheet/MMA8452Q.pdf
*/
i2c.transfer(new Buffer([0x01]), 6, function (error, dataReceived) {
// This is an exception. If an error is generated, it will throw the error
if (error) throw error;
//This array is going to store the final x,y,z values
var out=[];
/*
The for loop is iterated 3 times, in order to extract the x,y,z values.
The gCount variable is a bitwise OR operation between two binary numbers:
1. The OUT_MSB of the respective coordinate, that is left shifted by 8 bits in order to make space for the remaining 8 bits
of the OUT_LSB.
2. The OUT_LSB of the respective coordinate.
The OUT_LSB of the respective coordinate is right shifted by 4 to get rid of the redundant lower 0 bits which are 4 in number.
Check whether the most significant bit of the OUT_MSB is 1 or 0 i.e whether the coordinate value if negative or
positive. If it is negative (checked using 0x7F, which is the maximum possible number that can be made from 7 bits), the if condition changes
it to a 2's complement form, thus making it positive and adding a "-" sign in front of it.
Lastly, normalise the coordinate to get a value between 0 and 1, dividing the gCount by 2^10.
*/
for (var i=0;i<3;i++){
var gCount=(dataReceived[i*2] << 8) | dataReceived[(i*2)+1];
console.log(gCount);
gCount=gCount >> 4;
// 127 is checking whether we have a 0 or a 1 at the first position - basically its sign.
if (dataReceived[i*2] > 0x7F) {
gCount = -(1 + 0xFFF - gCount); // Transform into negative 2's complement
}
console.log(gCount);
out[i] = gCount / ((1<<12)/(2*2));
}
console.log('The x, y, z values are :',out);
});