first commitHEADmaster

1 files changed, 83 insertions, 0 deletions

diff --git a/cube_pc_test1/cube.c b/cube_pc_test1/cube.c
new file mode 100644
index 0000000..e0066e4
--- /dev/null
+++ b/cube_pc_test1/cube.c
@@ -0,0 +1,83 @@
+#include <stdio.h>
+#include <stdlib.h>
+#include "cube.h"
+#include <termios.h>
+#include <fcntl.h>
+#include <strings.h>
+
+void cube_push (unsigned char data[8][8])
+{
+	int x,y,i;
+
+	i= 0;
+
+	unsigned char buffer[200];
+
+	buffer[i++] = 0xff; // escape
+	buffer[i++] = 0x00; // reset to 0,0
+
+	for (x=0;x<8;x++)
+	{
+		for (y=0;y<8;y++)
+		{
+			buffer[i++] = data[x][y];
+			if (data[x][y] == 0xff)
+			{
+				buffer[i++] = data[x][y];
+			}
+		}
+	}
+
+	write(tty,&buffer,i);
+}
+
+int cube_init (const char* tty_path)
+{
+
+	//FILE *ftty;
+
+	//ftty = fopen("/dev/ttyUSB0","a");
+
+
+	struct termios io;
+
+	//char *tty_path = "/dev/ttyUSB0";
+	//char *tty_path = "/dev/ttyUSB1";
+
+	//tty = open(tty_path, O_RDWR | O_NOCTTY | O_NDELAY); // <-  ORIGINAL
+	tty = open(tty_path, O_RDWR);
+
+
+	if (tty <0) {perror(tty_path); exit(-1); }
+
+	bzero(&io, sizeof(io));
+	//io.c_cflag = B2400 | CRTSCTS | CS8 | CLOCAL | CREAD;
+	//io.c_cflag = B2400 | CRTSCTS | PARENB | CS8 | CLOCAL | CREAD;
+	io.c_cflag = B38400 | PARENB | CS8 | CLOCAL | CREAD;
+	//io.c_cflag = B19200 | PARENB | CS8 | CLOCAL | CREAD;
+	io.c_iflag = IGNPAR;
+	io.c_oflag = 0;
+
+	// set input mode (non-canonical, no echo,...)
+	io.c_lflag &= ~OPOST;
+	//io.c_lflag &= ~(ICANON | ECHO | ECHOE | ISIG);
+
+	io.c_cc[VTIME]    = 0;   // inter-character timer unused
+	io.c_cc[VMIN]     = 0;   // blocking read until 5 chars received
+
+	// Flush buffer
+	tcflush(tty, TCIFLUSH);
+
+    //cfsetospeed(&io, B1000000);
+	//cfsetispeed(&io, B1000000);
+
+	// write config to tty
+	tcsetattr(tty,TCSANOW,&io);
+
+
+	//fcntl(tty, F_SETFL, 0);
+
+
+
+	return 1;
+}