The program only run once, it digs one trench, the go back, says "Waiting for full batery" and then ends