added equation to calculate speed
changed equation for distance calculation; added a serial print for distance traveled