Added Variables to correctly calculate diameter

By knowing the diameter we can determine how far the robot actually
went.