arduino sketch for our quad project, trying out auto balance and collision detection