#! /usr/bin/python3
# Test program for module {heuristic2}
# Last edited on 2021-02-11 08:22:59 by jstolfi

import heuristic2
import path
import move 
import contact 
import hacks
import job_parms
import rn
import pyx
import sys
from math import sqrt,sin,cos,pi

parms = job_parms.typical()

# Create a filler set {FS}:
p0 = (2,2)
p1 = (3,7)
p2 = (5,5)
p3 = (3,2)
mv01 = move.make(p0, p1, False)
mv23 = move.make(p2, p3, False)
FS = [ mv01, mv23 ]

# Create a contact set{CS}:
CS = [ ]

Delta = 10   # Max allowed contact cooling time.
o = ( 1, 1 ) # Initial position of nozzle.

ph = heuristic2.best_path(o, FS, CS, Delta, parms, 0, False)