import os,sys
|
|
# add python path of src to sys.path
|
src_path = os.path.join(__file__, *(['..'] * 2))
|
src_path = os.path.abspath(src_path)
|
sys.path.insert(1, src_path)
|
|
from src.slam.autoMode import rotateAndMerge
|
|
if __name__ == "__main__":
|
def help():
|
print("Usage: auto_slam.py [servo_path][port] [speed] [degre_step] [time_delay] [alpha] [beta] [gamma] [microwaveHost] [udp_packets] [deviceName] [saveFolder]")
|
print("EXAMPLE: auto_slam.py ./RUN/Test_Servo.exe COM11 100 5 5 0 20 auto 192.168.2.65 1000 pod1 ./data/run_test/")
|
exit(1)
|
|
if len(sys.argv) != 13:
|
help()
|
try:
|
servo_path = str(sys.argv[1])
|
port = str(sys.argv[2])
|
speed = str(sys.argv[3])
|
degre_step = float(sys.argv[4])
|
time_delay = int(sys.argv[5])
|
alpha = str(sys.argv[6])
|
beta = str(sys.argv[7])
|
gamma = str(sys.argv[8])
|
microwaveHost = str(sys.argv[9])
|
udp_packets = int(sys.argv[10])
|
deviceName = str(sys.argv[11])
|
saveFolder = os.path.abspath(str(sys.argv[12]))
|
except Exception as e:
|
print(e)
|
help()
|
|
rotateAndMerge(servo_path,port,speed,degre_step,time_delay,alpha,beta,gamma,microwaveHost,udp_packets,deviceName,saveFolder)
|
print("Done")
|
