ir.c

来自「足球机器人自动程序」· C语言 代码 · 共 38 行

#include <stdlib.h>

#include "ttys.h"
#include "ir.h"

int main() {

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

	char c = 'a';
	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))) != 2) {
			fprintf(stderr, "error read\n");
			return -1;
		}

		int im = buf[1];
		im <<=8;
		im += buf[0];
		printf("%lf\n", ir_measure(im));
		sleep(1);
	}

	return 0;
}