ir.c

足球机器人自动程序

#include <stdlib.h>

#include "tty.h"
#include "ir.h"
#include "cmd.h"
#include "ctrl.h"

int main() {

        int fd = ttys_init(0);
	if (fd < 0) {
		return -1;
	}
	ctrl_init(fd);

	char c = IR;
	unsigned char buf[10];

	for (;;) {
		if (write(fd, &c, 1) != 1) {
			fprintf(stderr, "error write\n");
			return -1;
		}

		int n;
		if ((n = read(fd, &buf, sizeof(buf))) != 5) {
			fprintf(stderr, "error read\n");
			return -1;
		}

		//printf("%lf\n", ir_measure(buf[0]));
		printf("%hhx: %hhu\n", buf[0], buf[2]);
		sleep(1);
	}

	return 0;
}