if __name__ == '__main__':
import argparse
from mesh import Mesh
from mlabplot import MPlot3D
parser = argparse.ArgumentParser()
parser.add_argument('-d', '--data', type=str,
default='/home/baltasar/Documentos/celda4/proper/tacos gnc/taco.stl',#/home/baltasar/Documentos/proper/points datapixel/P1DevMap/P1ModelDevMap.stl /home/baltasar/Documentos/celda4/proper/tacos gnc/taco.stl
help='path to input stl data file')
args = parser.parse_args()
filename = args.data
# Triangle mesh is composed by a set of faces (triangles)
mesh = Mesh(filename)
mesh.resort_triangles()
slice = mesh.get_slice(7.98)
# t0 = time.time()
# slices = mesh.get_mesh_slices(0.5)
# t1 = time.time()
# print 'Time for slices:', t1 - t0
slices = []
slices.append(slice)
fp = slice[0][0]
lp = slice[0][-1]
planning = Planning()
t0 = time.time()
path = planning.get_path_from_slices(slices, 2.16, degrees=45.0)
