Added serial prints to show why robot isn't moving