Skip to content

Commit 0c556c1

Browse files
committed
got scaling working
1 parent d95cde5 commit 0c556c1

File tree

1 file changed

+24
-18
lines changed

1 file changed

+24
-18
lines changed

adafruit_tlv493d.py

Lines changed: 24 additions & 18 deletions
Original file line numberDiff line numberDiff line change
@@ -157,36 +157,42 @@ def _set_write_key(self, key, value):
157157
current_write_byte &= ~write_mask
158158
current_write_byte |= value<<write_shift
159159
self.write_buffer[write_byte_num] = current_write_byte
160+
161+
# @staticmethod
162+
# def binPrint(number, places=16, end_str=""):
163+
# out = []
164+
# for i in range(places):
165+
# dig_shift = number >> i
166+
# if dig_shift & 1:
167+
# out.append("1")
168+
# else:
169+
# out.append("0")
170+
# out.reverse()
171+
# print("".join(out), end=end_str)
160172

161173
@property
162174
def x(self):
163175
self._read_i2c()
164176
x_top = self._get_read_key("BX1")
165-
x_bot = self._get_read_key("BX2")
166-
x_val = x_top<<4 | x_bot
167-
xtop = (x_val & 0xFF00)>>8
168-
xbot = (x_val & 0x00FF)
169-
binval = struct.unpack_from(">h", bytearray([xtop, xbot]))[0]
170-
return binval
177+
x_bot = ((self._get_read_key("BX2") << 4) & 0xFF)
178+
binval = struct.unpack_from(">h", bytearray([x_top, x_bot]))[0]
179+
binval = binval >>4
180+
return binval * 0.098
171181

172182
@property
173183
def y(self):
174184
self._read_i2c()
175185
y_top = self._get_read_key("BY1")
176-
y_bot = self._get_read_key("BY2")
177-
y_val = y_top<<4 | y_bot
178-
ytop = (y_val & 0xFF00)>>8
179-
ybot = (y_val & 0x00FF)
180-
binval = struct.unpack_from(">h", bytearray([ytop, ybot]))[0]
181-
return binval
186+
y_bot = ((self._get_read_key("BY2") << 4) & 0xFF)
187+
binval = struct.unpack_from(">h", bytearray([y_top, y_bot]))[0]
188+
binval = binval >>4
189+
return binval * 0.098
182190

183191
@property
184192
def z(self):
185193
self._read_i2c()
186194
z_top = self._get_read_key("BZ1")
187-
z_bot = self._get_read_key("BZ2")
188-
z_val = z_top<<4 | z_bot
189-
ztop = (z_val & 0xFF00)>>8
190-
zbot = (z_val & 0x00FF)
191-
binval = struct.unpack_from(">h", bytearray([ztop, zbot]))[0]
192-
return binval
195+
z_bot = ((self._get_read_key("BZ2") << 4) & 0xFF)
196+
binval = struct.unpack_from(">h", bytearray([z_top, z_bot]))[0]
197+
binval = binval >>4
198+
return binval * 0.098

0 commit comments

Comments
 (0)