Merge cb2ca58e4b into 1520ab5b98

bcmserver.c

@@ -153,7 +153,7 @@ int main(void)
 
 	char buf[MAXLEN];
 	char format[FORMATSZ];
-	char rxmsg[64];
+	char rxmsg[50];
 
 #pragma GCC diagnostic push
 #pragma GCC diagnostic ignored "-Wpragmas"
@@ -234,7 +234,7 @@ int main(void)
 	}
 
 	while (1) {
-again:
+
 		FD_ZERO(&readfds);
 		FD_SET(sc, &readfds);
 		FD_SET(sa, &readfds);
@@ -242,8 +242,6 @@ again:
 		select((sc > sa)?sc+1:sa+1, &readfds, NULL, NULL, NULL);
 
 		if (FD_ISSET(sc, &readfds)) {
-			size_t size = sizeof(rxmsg);
-			int len = 0, res;
 
 			recvfrom(sc, &msg, sizeof(msg), 0,
 				 (struct sockaddr*)&caddr, &caddrlen);
@@ -251,35 +249,17 @@ again:
 			ifr.ifr_ifindex = caddr.can_ifindex;
 			ioctl(sc, SIOCGIFNAME, &ifr);
 
-			res = snprintf(rxmsg, size, "< %s %03X %d ", ifr.ifr_name,
+			sprintf(rxmsg, "< %s %03X %d ", ifr.ifr_name,
-				       msg.msg_head.can_id, msg.frame.can_dlc);
+				msg.msg_head.can_id, msg.frame.can_dlc);
-			if (res < 0 || (size_t)res >= size) {
-				printf("Error: rxmsg buffer (size %zu) too small for data.\n", size);
-				continue;
-			}
 
-			len += res;
+			for ( i = 0; i < msg.frame.can_dlc; i++)
-
+				sprintf(rxmsg + strlen(rxmsg), "%02X ",
-			for (i = 0; i < msg.frame.can_dlc; i++) {
+					msg.frame.data[i]);
-				res = snprintf(rxmsg + len, size - len, "%02X ", msg.frame.data[i]);
-				if (res < 0 || (size_t)res >= (size - len)) {
-					printf("Error: rxmsg buffer (size %zu) too small for data.\n", size);
-					goto again;
-				}
-
-				len += res;
-			}
 
 			/* delimiter '\0' for Adobe(TM) Flash(TM) XML sockets */
-			res = snprintf(rxmsg + len, size - len, ">");
+			strcat(rxmsg, ">\0");
-			if (res < 0 || (size_t)res >= (size - len)) {
-				printf("Error: rxmsg buffer (size %zu) too small for data.\n", size);
-				continue;
-			}
 
-			len += res;
+			send(sa, rxmsg, strlen(rxmsg) + 1, 0);
-
-			send(sa, rxmsg, len + 1, 0);
 		}
 
 

canerrsim.c

@@ -25,7 +25,6 @@
 #include <linux/can/error.h>
 #include <linux/can/raw.h>
 #include <net/if.h>
-#include <stdarg.h>
 #include <stdbool.h>
 #include <stdint.h>
 #include <stdio.h>
@@ -123,25 +122,27 @@ void show_help_and_exit()
 	exit(EXIT_SUCCESS);
 }
 
-void __attribute__((format (printf, 1, 2))) err_exit(const char *format, ...)
+void err_exit(const char *msg)
 {
-	va_list ap;
+	printf("%s", msg);
-
-	va_start(ap, format);
-	vfprintf(stdout, format, ap);
-	va_end(ap);
-
 	exit(EXIT_FAILURE);
 }
 
+void show_custom_format_and_exit(const char *param, const char *format)
+{
+	char str_buf[80];
+	sprintf(str_buf, format, param);
+	err_exit(str_buf);
+}
+
 void show_invalid_option(const char *option)
 {
-	err_exit("Error: Invalid option %s\n", option);
+	show_custom_format_and_exit(option, "Error: Invalid option %s\n");
 }
 
 void show_err_and_exit(const char *err_type)
 {
-	err_exit("Error: You can only have one %s parameter!\n", err_type);
+	show_custom_format_and_exit(err_type, "Error: You can only have one %s parameter!\n");
 }
 
 void show_loc_err_and_exit()
@@ -175,6 +176,7 @@ int main(int argc, char *argv[])
 	struct ifreq ifr;
 	struct can_frame frame;
 	bool show_bits = false, location_processed = false, transceiver_processed = false, arbitration_processed = false;
+	char tmp_str[256];
 
 	printf("CAN Sockets Error Messages Simulator\n");
 	if (argc < 3)
@@ -535,25 +537,24 @@ int main(int argc, char *argv[])
 
 	// create socket
 	if ((sock = socket(PF_CAN, SOCK_RAW, CAN_RAW)) < 0)
-		err_exit("Error while opening socket\n");
+		err_exit("Error while opening socket");
 
 	// set interface name
-	if (strlen(argv[1]) >= IFNAMSIZ)
-		err_exit("Name of CAN device '%s' is too long!\n\n", argv[1]);
-
 	strcpy(ifr.ifr_name, argv[1]); // can0, vcan0...
-	if (ioctl(sock, SIOCGIFINDEX, &ifr) < 0)
+	if (ioctl(sock, SIOCGIFINDEX, &ifr) < 0) {
-		err_exit("Error setting CAN interface name %s\n", argv[1]);
+		sprintf(tmp_str, "Error setting CAN interface name %s", argv[1]);
+		err_exit(tmp_str);
+	}
 
 	// bind socket to the CAN interface
 	addr.can_family = AF_CAN;
 	addr.can_ifindex = ifr.ifr_ifindex;
 	if (bind(sock, (struct sockaddr *)&addr, sizeof(addr)) < 0)
-		err_exit("Error in socket bind\n");
+		err_exit("Error in socket bind");
 
 	// Send CAN error frame
 	if (write(sock, &frame, sizeof(frame)) < 0)
-		err_exit("Error writing to socket\n");
+		err_exit("Error writing to socket");
 	else
 		printf("CAN error frame sent\n");