Dual axis Arduino Heliostat using math for position