from tiberius.control.control import Control
import sys
import traceback
c = Control()
g = Algorithms(c)
algo = sys.argv[1]
latitude = []
longitude = []
speedpercent = 50
points = []
j = 0
'''
latitude = sys.argv[1]
longitude = sys.argv[2]
g.pointToPoint([latitude,longitude], check, speedpercent)
'''
try:
for i in range(2, sys.argv.__len__() - 2, 2):
latitude.append(sys.argv[i])
longitude.append(sys.argv[i + 1])
points.append([latitude[j], longitude[j]])
j += 1
speedpercent = int(sys.argv[sys.argv.__len__() - 1])
print 'Speed: ' + str(speedpercent)
print 'lat: ' + str(latitude)
