--1:z+  2:x-   3:z-  4:x+
local args = {...}
local wX=-861
local wY=68
local wZ=-566

--Functii
function turn(poz)
	print("Turn " .. poz)
	local run2=1
	if poz==heading then
		return
	end
	if poz==heading-1 then
		turtle.turnLeft()
		run2=0
	end
	if poz==4 then
		if heading==1 then
			turtle.turnLeft()
			run2=0
		end
	end
	if poz==1 then
		if heading==4 then
			turtle.turnRight()
			run2=0
		end
	end
	if run2==1 then
		if poz==heading+1 then
			turtle.turnRight()
		else
			turtle.turnRight()
			turtle.turnRight()
		end
	end

	heading = poz
	save_coord()
end
function mergi_coord(X_dorit, Y_dorit, Z_dorit, prioritate_Y)
	if prioritate_Y==1 then
		mergi_y(Y_dorit)
	end
	mergi_x(X_dorit)
	mergi_z(Z_dorit)
	if prioritate_Y==0 then
		mergi_y(Y_dorit)
	end
end
function mergi_x(X_dorit)
	local add_val=0
	if my_X>X_dorit then
		turn(2)
		add_val=-1
	elseif my_X<X_dorit then
		turn(4)
		add_val=1
	end
	local de_mers=math.abs(my_X-X_dorit)
	print("Merg pe X "..de_mers)
	for i=1,de_mers do
		turtle.dig()
		turtle.forward()
		my_X=my_X+add_val
		save_coord()
	end
end
function mergi_z(Z_dorit)
	local add_val=0
	if my_Z>Z_dorit then
		turn(3)
		add_val=-1
	elseif my_Z<Z_dorit then
		turn(1)
		add_val=1
	end
	local de_mers=math.abs(my_Z-Z_dorit)
	print("Merg pe Z "..de_mers)
	for i=1,de_mers do
		turtle.dig()
		turtle.forward()
		my_Z=my_Z+add_val
		save_coord()
	end
end
function mergi_y(Y_dorit)
	local de_mers=math.abs(my_Y-Y_dorit)
	print("Merg pe Y "..de_mers)
	if my_Y>Y_dorit then
		for i=1,de_mers do
			turtle.digDown()
			turtle.down()
			my_Y=my_Y-1
			save_coord()
		end
	elseif my_Y<Y_dorit then
			for i=1,de_mers do
			turtle.digUp()
			turtle.up()
			my_Y=my_Y+1
			save_coord()
		end
	end
end
function load_coord()
	--load home
	local home_file = fs.open("home.lua", "r")
	home_X=tonumber(home_file.readLine())
	home_Y=tonumber(home_file.readLine())
	home_Z=tonumber(home_file.readLine())
	home_file.close()
	--load my_coord
	local my_file = fs.open("my.lua", "r")
	my_X=tonumber(my_file.readLine())
	my_Y=tonumber(my_file.readLine())
	my_Z=tonumber(my_file.readLine())
	heading=tonumber(my_file.readLine())
	my_file.close()
	print(heading)
end
function save_coord()
	local my_file = fs.open("my.lua", "w")
	my_file.write(tostring(my_X))
	my_file.write("\n")
	my_file.write(tostring(my_Y))
	my_file.write("\n")
	my_file.write(tostring(my_Z))
	my_file.write("\n")
	my_file.write(tostring(heading))
	my_file.write("\n")
	my_file.close()
end


load_coord()
mergi_coord(tonumber(args[1]),tonumber(args[2]),tonumber(args[3]),1)
save_coord()