rushilwiz/engine-software
1
0
Fork 0
mirror of https://github.com/PotentiaRobotics/engine-software.git synced 2025-04-17 18:40:18 -04:00
Code Issues Actions Packages Projects Releases Wiki Activity

Updated Mode 0

Browse Source
This commit is contained in:
FluffyCube9343 2022-08-10 09:04:04 -04:00
parent e9e2bc6426
commit 480e959a99
1 changed files with 16 additions and 12 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

28
comms/RPi/RPICOM.py
View File

@ -10,9 +10,9 @@ import serial
import os import os
ser = serial.Serial('/dev/ttyACM0',115200) ser = serial.Serial('/dev/ttyACM0',115200)
mode = 2 mode = 0
#-1 = do not use offsets at all (just get and print data do nothing with it) #-1 = do not use offsets at all (just get and print data do nothing with it)
#0 = start new offsets (delete offsets.txt and make/overwrite) #0 = start new offsets (delete offsets.txt and make/overwrite new ones)
#1 = use offsets but do not overwrite #1 = use offsets but do not overwrite
#2 = use and apply existing offsets, and overwrite #2 = use and apply existing offsets, and overwrite
@ -73,6 +73,9 @@ if(mode==0):
wfile.write("1.00 0.00 0.00 0.00\n") wfile.write("1.00 0.00 0.00 0.00\n")
wfile.write("1.00 0.00 0.00 0.00\n") wfile.write("1.00 0.00 0.00 0.00\n")
wfile.write("1.00 0.00 0.00 0.00\n") wfile.write("1.00 0.00 0.00 0.00\n")
with open('offsets.txt') as rfile:
data = rfile.readlines()
elif(mode==1 or mode==2): elif(mode==1 or mode==2):
with open('offsets.txt') as rfile: with open('offsets.txt') as rfile:
data = rfile.readlines() data = rfile.readlines()
@ -130,9 +133,9 @@ while True:
proper[3] += a4 proper[3] += a4
done = " ".join(list(map(str,proper))) done = " ".join(list(map(str,proper)))
if(mode>=1): if(mode>=0):
print(done) print(done)
if(mode==2): if(mode==2 or mode==0):
data[0] = done+"\n" data[0] = done+"\n"
log.write("A "+done+"\n") log.write("A "+done+"\n")
@ -148,9 +151,9 @@ while True:
proper[2] += b3 proper[2] += b3
proper[3] += b4 proper[3] += b4
done = " ".join(list(map(str,proper))) done = " ".join(list(map(str,proper)))
if(mode>=1): if(mode>=0):
print(done) print(done)
if(mode==2): if(mode==2 or mode==0):
data[1] = done+"\n" data[1] = done+"\n"
log.write("B "+done+"\n") log.write("B "+done+"\n")
@ -165,9 +168,9 @@ while True:
proper[2] += c3 proper[2] += c3
proper[3] += c4 proper[3] += c4
done = " ".join(list(map(str,proper))) done = " ".join(list(map(str,proper)))
if(mode>=1): if(mode>=0):
print(done) print(done)
if(mode==2): if(mode==2 or mode==0):
data[2] = done+"\n" data[2] = done+"\n"
log.write("C "+done+"\n") log.write("C "+done+"\n")
@ -183,13 +186,14 @@ while True:
proper[2] += d3 proper[2] += d3
proper[3] += d4 proper[3] += d4
done = " ".join(list(map(str,proper))) done = " ".join(list(map(str,proper)))
if(mode>=1): if(mode>=0):
print(done) print(done)
if(mode==2): if(mode==2 or mode==0):
data[3] = done+"\n" data[3] = done+"\n"
log.write("D "+done+"\n") log.write("D "+done+"\n")
except: except:
print("Under 4 numbers") print("Under 4 numbers")
with open("offsets.txt", "w") as wfile: if(mode==0 or mode==2):
wfile.writelines(data) with open("offsets.txt", "w") as wfile:
wfile.writelines(data)