File size: 1,744 Bytes
a0c8e54 | 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 | from smbus2 import SMBus
import time
import struct
I2C_BUS_NUMBER = 7
# I2C address of the Arduino
ARDUINO_I2C_ADDRESS = 0x08
# Total number of bytes to read (24 floats * 4 bytes per float)
TOTAL_BYTES = 96
# Maximum bytes per I2C transaction (due to limitations)
CHUNK_SIZE = 32
OUTPUT_FILE = "right_data.txt"
def read_i2c_data(bus, addr, total_bytes, chunk_size):
data = []
chunks = (total_bytes + chunk_size - 1) // chunk_size
for chunk_index in range(chunks):
# Use read_i2c_block_data which sends a command byte before reading data
to_read = min(chunk_size, total_bytes - (chunk_index * chunk_size))
chunk_data = bus.read_i2c_block_data(addr, chunk_index, to_read)
data.extend(chunk_data)
return data
with SMBus(I2C_BUS_NUMBER) as bus, open(OUTPUT_FILE,'w') as f: # Use the correct I2C bus number
while True:
try:
# Read data in chunks
data = read_i2c_data(bus, ARDUINO_I2C_ADDRESS, TOTAL_BYTES, CHUNK_SIZE)
# Convert byte data to floats
floats = []
for i in range(0, TOTAL_BYTES, 4):
# Combine 4 bytes into a float
float_bytes = bytes(data[i:i+4])
value = struct.unpack('<f', float_bytes)[0] # '<f' for little-endian float
floats.append(value)
# Split into master and slave data
masterData = floats[:12]
slaveData = floats[12:]
# Print the data
f.write(f"{time.time()}\nM: {masterData}\nS:{slaveData}")
# print(f"{time.time()}\nM: {masterData}\nS:{slaveData}")
except Exception as e:
f.write(f"Error: {e}")
# print((f"Error: {e}"))
|