from writers.csv import csv
from DataLogger import DataLogger
from time import sleep
from devices.ArduinoDevice import ArduinoDevice
writer = csv('testLog')
logger = DataLogger(writer)
logger.add_device(ArduinoDevice())
logger.start()
try:
while True:
print("hi")
sleep(1)
finally:
logger.end()
from RaspberryPi.rpy_pid_controller.devices.mpu6050 import mpu6050
from RaspberryPi.game_controller.xbox_controller import XboxController
from DataLogger import DataLogger
from writers.csv import csv
from time import sleep
writer = csv('APR7_')
logger = DataLogger(writer)
imu = mpu6050(0x68)
pid = pid_wrapper(imu)
motors = MotorController()
ctrlr = XboxController()
logger.add_device(imu)
logger.add_device(pid)
logger.add_device(motors)
logger.add_device(ctrlr)
targets = [0, 0] #FIXME Need Correct target angles and correct orientation yaw angle.
pid.set_targets(targets)
pid.run()
logger.start()
ctrlr.start()
ctrlrdata_old = ctrlrdata = ctrlr.get_speeds()
count = 0
try:
while True:
