Added some preliminary code to test the tower-to-opposite, segmented-line-and-perpendiculars test.
Also, figured out how to reset IK without having to wait for zprobe->home() to complete, which should knock a lot of time off testing.