BiBoard Serial Port

Consider this bit of refactoring Jujutsu to resolve the problem.

The goal is to have print6Axis print to the second serial  port  (if not all output ports).

The issue is print6Axis formats the output using macros that are tied to the USB serial port.

We would like to separate the output formatting from the serial  port. We don't want to change the macros because they're extensively used in other code. Instead we use a local buffer to hold the formatted output and then print that buffer to the appropriate ports.

void print6Axis() {
    // format the output ...
    auto fmt{
        "%.2f\t%.2f\t%.2f\t"
        "%d\t%d\t%d\t"
        "%.2f"
    };
    char text[80 + 1]{};	// 1 line + nul
    int len{
        snprintf(
            text
            , sizeof(text) - 1
            , fmt
            , ypr[0], ypr[1], ypr[2]
            , xyzReal[0], xyzReal[1], xyzReal[2]
            , aaWorld.z
        )
    };
    if (0 < len) {
        printToAllPorts(text);
    }
}