1 files changed, 112 insertions, 0 deletions
diff --git a/cansend.c b/cansend.c
new file mode 100644
index 0000000..baffd69
--- /dev/null
+++ b/cansend.c
@@ -0,0 +1,112 @@
+#include <stdio.h>
+#include <stdlib.h>
+#include <unistd.h>
+#include <string.h>
+#include <signal.h>
+#include <libgen.h>
+
+#include <sys/types.h>
+#include <sys/socket.h>
+#include <sys/uio.h>
+#include <sys/ioctl.h>
+#include <net/if.h>
+
+#include "can.h"
+
+extern int optind, opterr, optopt;
+static int	running = 1;
+
+void sigterm(int signo)
+{
+	running = 0;
+}
+
+int main(int argc, char **argv)
+{
+	int family = PF_CAN, type = SOCK_RAW, proto = CAN_PROTO_RAW;
+	struct sockaddr_can addr;
+	int s, opt, ret, i;
+	struct can_frame frame;
+	int verbose = 0;
+	int num = 0;
+	struct ifreq ifr;
+
+	signal(SIGTERM, sigterm);
+	signal(SIGHUP, sigterm);
+
+	while ((opt = getopt(argc, argv, "f:t:p:vi:")) != -1) {
+		switch (opt) {
+			case 'f':
+				family = atoi(optarg);
+				break;
+
+			case 't':
+				type = atoi(optarg);
+				break;
+
+			case 'p':
+				proto = atoi(optarg);
+				break;
+
+			case 'v':
+				verbose = 1;
+				break;
+			
+			case 'i':
+				frame.can_id = atoi(optarg);
+
+			case '?':
+				break;
+
+			default:
+				fprintf(stderr, "Unknown option %c\n", opt);
+				break;
+		}
+	}
+	
+	if (argv[optind] == NULL) {
+		fprintf(stderr, "No Interface supplied\n");
+		exit(-1);
+	}
+
+	printf("interface = %s, family = %d, type = %d, proto = %d\n",
+	       argv[optind], family, type, proto);
+	if ((s = socket(family, type, proto)) < 0) {
+		perror("socket");
+		return 1;
+	}
+
+	addr.can_family = family;
+	strcpy(ifr.ifr_name, argv[optind]);
+	ret = ioctl(s, SIOCGIFINDEX, &ifr);
+	printf("ioctl: %d ", ret);
+	addr.can_ifindex = ifr.ifr_ifindex;
+	addr.can_id = frame.can_id;
+
+	if (bind(s, (struct sockaddr *)&addr, sizeof(addr)) < 0) {
+		perror("bind");
+		return 1;
+	}
+
+	if (argv[optind+1] != NULL) {
+		frame.can_dlc = strlen(argv[optind+1]);
+		frame.can_dlc = frame.can_dlc > 8 ? 8 : frame.can_dlc;
+		strncpy(frame.payload.byte, argv[optind+1],8);
+	} else {
+		frame.can_dlc = 0;
+	}
+
+	printf("id: %d ",frame.can_id);
+	printf("dlc: %d\n",frame.can_dlc);
+	for(i = 0; i < frame.can_dlc; i++)
+		printf("0x%02x ",frame.payload.byte[i]);
+	printf("\n");
+
+	num = 1;
+	while (num--) {
+		ret = write(s, &frame, sizeof(frame));
+	}
+
+	close(s);
+	return 0;
+}