[Tz0m]

The code is:

printf("Distance = %d", DistanceCalc(TILT_SERVO));

The code for the DistanceCalc function is:

int DistanceCalc(int tiltS)
{
int tiltD, tiltR, dist;
tiltD = ((tiltS - 124) * 65) / 124;
tiltR = (tiltD * 3.14159265) / 180.0;
dist = 80.0 / tan(tiltR);
return dist;
}