Checkpoint on radar unit test development.

Task @T62 : Now we are getting the correct results all the time.
Still need to alter radar_mk1 so it's returning realitive vectors
instead of abosolute, and alter the unit test to validate the results
(to this point I've been validating using the MK1 eyeball).