Updated display code to display health at all times.  Also moved debug display to its own function and massaged it to look nicer.  Now displays position, orientation, RTT, and update time.  Controlled by ON_SCREEN_DEBUG define.
Moved DEBUG and ON_SCREEN_DEBUG defines into main.h.  They now control debugging output for both Client and Server.  Fixed small macro issues when debugging in server.