Added initial/enhanced support for toolsetter and second probe input.

Moved inbuilt G65 macros to the core and added macro G65P5Q<n> for selecting probe.
Added probe id to real time report: |P:<n> will be reported on probe select when more than one probe is available.
Fix for WCO and Ov real time status report elements not beeing reported as they should in some circumstances.

protocol.c

@@ -869,6 +869,7 @@ ISR_CODE bool ISR_FUNC(protocol_enqueue_realtime_command)(char c)
                 report.value = (uint32_t)Report_All;
                 report.tool_offset = sys.report.tool_offset;
                 report.m66result = sys.var5399 > -2;
+                report.probe_id = !!hal.probe.select;
 
                 system_add_rt_report((report_tracking_t)report.value);
             }