@@ -44,93 +44,92 @@ void newMONCOMMS(UBX_MON_COMMS_data_t *ubxDataStruct)
4444 // Mimic the data shown in u-center
4545 for (uint8_t port = 0 ; port < ubxDataStruct->header .nPorts ; port++) // For each port
4646 {
47- bool known = true ;
48- switch (ubxDataStruct->port [port].portId ) // Check the port ID is valid
47+ // Check the port ID is valid (skip 0x0101 and 0x0200)
48+ bool validPort = false ;
49+ switch (ubxDataStruct->port [port].portId )
4950 {
5051 case COM_PORT_ID_I2C:
5152 case COM_PORT_ID_UART1:
5253 case COM_PORT_ID_UART2:
5354 case COM_PORT_ID_USB:
5455 case COM_PORT_ID_SPI:
55- break ;
56- default :
57- known = false ;
56+ validPort = true ;
5857 break ;
59- }
60- if (!known)
61- break ; // Skip if port ID is not known
62-
63- switch (ubxDataStruct->port [port].portId ) // Print the port ID
64- {
65- case COM_PORT_ID_I2C:
66- Serial.print (F (" I2C " ));
67- break ;
68- case COM_PORT_ID_UART1:
69- Serial.print (F (" UART1 " ));
70- break ;
71- case COM_PORT_ID_UART2:
72- Serial.print (F (" UART2 " ));
73- break ;
74- case COM_PORT_ID_USB:
75- Serial.print (F (" USB " ));
76- break ;
77- case COM_PORT_ID_SPI:
78- Serial.print (F (" SPI " ));
79- break ;
8058 default :
81- Serial.print (F (" UNKNOWN " ));
82- // Serial.printf("0x%04X ", ubxDataStruct->port[port].portId);
59+ // Serial.printf("Unknown / reserved portId 0x%04X\r\n", ubxDataStruct->port[port].portId);
8360 break ;
8461 }
8562
86- Serial.print (" : txBytes " );
87- String txBytes = String (ubxDataStruct->port [port].txBytes );
88- Serial.print (txBytes);
89- for (int i = 0 ; i < 10 - txBytes.length (); i++)
90- Serial.print (" " );
91-
92- Serial.print (" : rxBytes " );
93- String rxBytes = String (ubxDataStruct->port [port].rxBytes );
94- Serial.print (rxBytes);
95- for (int i = 0 ; i < 10 - rxBytes.length (); i++)
96- Serial.print (" " );
97-
98- for (int i = 0 ; i < 4 ; i++)
63+ if (validPort)
9964 {
100- if (ubxDataStruct->header .protIds [i] < 0xFF )
65+ switch (ubxDataStruct->port [port].portId ) // Print the port ID
66+ {
67+ case COM_PORT_ID_I2C:
68+ Serial.print (F (" I2C " ));
69+ break ;
70+ case COM_PORT_ID_UART1:
71+ Serial.print (F (" UART1 " ));
72+ break ;
73+ case COM_PORT_ID_UART2:
74+ Serial.print (F (" UART2 " ));
75+ break ;
76+ case COM_PORT_ID_USB:
77+ Serial.print (F (" USB " ));
78+ break ;
79+ case COM_PORT_ID_SPI:
80+ Serial.print (F (" SPI " ));
81+ break ;
82+ }
83+
84+ Serial.print (" : txBytes " );
85+ String txBytes = String (ubxDataStruct->port [port].txBytes );
86+ Serial.print (txBytes);
87+ for (int i = 0 ; i < 10 - txBytes.length (); i++)
88+ Serial.print (" " );
89+
90+ Serial.print (" : rxBytes " );
91+ String rxBytes = String (ubxDataStruct->port [port].rxBytes );
92+ Serial.print (rxBytes);
93+ for (int i = 0 ; i < 10 - rxBytes.length (); i++)
94+ Serial.print (" " );
95+
96+ for (int i = 0 ; i < 4 ; i++)
10197 {
102- switch (ubxDataStruct->header .protIds [i])
98+ if (ubxDataStruct->header .protIds [i] < 0xFF )
10399 {
104- case 0 :
105- Serial.print (F (" : UBX " ));
106- break ;
107- case 1 :
108- Serial.print (F (" : NMEA " ));
109- break ;
110- case 2 :
111- Serial.print (F (" : RTCM2 " ));
112- break ;
113- case 5 :
114- Serial.print (F (" : RTCM3 " ));
115- break ;
116- case 6 :
117- Serial.print (F (" : SPARTN " ));
118- break ;
119- default :
120- Serial.print (F (" : UNKNOWN " ));
121- break ;
100+ switch (ubxDataStruct->header .protIds [i])
101+ {
102+ case 0 :
103+ Serial.print (F (" : UBX " ));
104+ break ;
105+ case 1 :
106+ Serial.print (F (" : NMEA " ));
107+ break ;
108+ case 2 :
109+ Serial.print (F (" : RTCM2 " ));
110+ break ;
111+ case 5 :
112+ Serial.print (F (" : RTCM3 " ));
113+ break ;
114+ case 6 :
115+ Serial.print (F (" : SPARTN " ));
116+ break ;
117+ default :
118+ Serial.print (F (" : UNKNOWN " ));
119+ break ;
120+ }
121+ String msgs = String (ubxDataStruct->port [port].msgs [i]);
122+ Serial.print (msgs);
123+ for (int i = 0 ; i < 5 - msgs.length (); i++)
124+ Serial.print (" " );
122125 }
123- String msgs = String (ubxDataStruct->port [port].msgs [i]);
124- Serial.print (msgs);
125- for (int i = 0 ; i < 5 - msgs.length (); i++)
126- Serial.print (" " );
127126 }
127+
128+ Serial.print (" : skipped " );
129+ Serial.print (ubxDataStruct->port [port].skipped );
130+
131+ Serial.println ();
128132 }
129-
130- Serial.print (" : skipped " );
131- Serial.print (ubxDataStruct->port [port].skipped );
132-
133- Serial.println ();
134133 }
135134}
136135
0 commit comments