local component = require("component")
local computer = require("computer")
local robot = require("robot")
local sides = require("sides")

print("diggy hole!")
origin = 0
y_branch = 0
max_lenght = 5
max_branch_lenght = 5
branch_distance = 5
torch_distance = 6
torch_counter = 0
resume = 0

function truemove()
    if robot.detect() == true then
        print("strada bloccata")
        os.sleep(1)
    else
        print("strada aperta!")
        robot.forward()
        origin = origin - 1

    end
end

function check_roba()
    if computer.energy() < 2000 then
        resume = origin
    else if robot.durability() < 0.1 then
        resume = origin
    end
end



function column_dig(y)
    for k=1,y do
        robot.swingUp()
        robot.up()
    end
    for z=y,1,-1 do
        robot.down()
        if z == 1 and torch_counter == torch_distance then
            robot.select(1)
            robot.placeUp(sides.right)
            torch_counter = 0
        end
    end
end

function branch(l)
    robot.turnLeft()
    if robot.detect() == true then
        torch_counter = 3
        print("torciacontatore" .. torch_counter)
        for i=1,l do
            robot.swing()
            robot.forward()
            torch_counter = torch_counter +1
            column_dig(y_branch)
        end
        for i=1, l do
            robot.back()
            torch_counter = 3
        end
    else
        print("debug: non serve scavare a sinistra!")
    end

    robot.turnLeft()
    robot.turnLeft()

    if robot.detect() == true then
        for i=1,l do
            robot.swing()
            robot.forward()
            torch_counter = torch_counter +1
            column_dig(y_branch)
        end
        for i=1,l do
            robot.back()
        end
    else
        print("debug: non serve scavare a destra!")
    end

    robot.turnLeft()
end


function main_dig(l,d)
    for i=1,l do
        for k =1,d do
            robot.swing()
            robot.forward()
            origin = origin + 1
            if robot.detectUp() == true then
                column_dig(y_branch)
                print("debug: superatocolumn_dig branch centrale!")
            else
                print("debug: non serve scavare!")
            end
        end
    branch(max_branch_lenght)
    check_roba()
   if resume ~= 0 then
            return_home(resume,0)
    end
end

function return_home(x,z)
    robot.turnLeft()
    robot.turnLeft()
    while origin > z do
        truemove()
    end
    robot.turnLeft()
    robot.turnLeft()
    resume = 0
end



print("Definisci altezza del branch!: ")
y_branch = io.read()
y_branch = y_branch - 1
main_dig(max_lenght, branch_distance)
return_home(origin, 0)