temporary debug printing of distance
updated lap distance debug output to csv format
switched to optimized fast square root implementation (from Quake III engine\!) and embedded cosine() function, eliminating reference to math.h. Reduced SAM7s firmware image from 229152 to 224516; 4636 byte savings, plus significant CPU performance savings due to lightweight square root function