# Begin modules
import sys

import numpy as np
from scipy import interpolate
import matplotlib.pyplot as plt

sys.path.append("../CycloneHost")
import CycloneHost as cy
# End modules

cy.connect(BAUDRATE, DEVICE, Emulate)

cy.sendCommand("G90\n") # Set absolute positioning

cy.homeZXY() # Home all the axis

# (x,y)
#grid_origin = (0,0)	# Initial point of the grid [mm]
#grid_len = (135,84)	# Distance to probe [mm]
#grid_N = (12,6)	# Number of points
grid_origin = (0,0)	# Initial point of the grid [mm]
grid_len = (80,60)	# Distance to probe [mm]
grid_N = (5,5)	# Number of points (AT LEAST 4 IN EACH DIRECTION, OTHERWISE INTERPOLATION WILL FAIL)

Zlift = 0.5 # mm

F_slowMove = 100

# Warning: Do not lower too much or you will potentially cause damage!
initial_Z_lowering_distance = -10