Subversion Repositories openrisc_me

#include "common.h"
#include "support.h"
#include "spi.h"
 
int touch_cmd(int argc, char *argv[])
{
	unsigned long x, y, z1, z2;
	float res;
 
	if (argc == 0) {
		printf("usage:  -r  read coordinates\n");
		printf
		    ("        -c  read coordinates in a loop (press any key to exit)\n");
	} else if (argc == 1) {
		if (!strcmp(argv[0], "-r")) {
			spi_init(0, 1000000, 21, 0, 1, 0);
			printf("X = %.3lx\n", spi_xmit(0xd3l << 13) & 0xfff);
			printf("Y = %.3lx\n", spi_xmit(0x93l << 13) & 0xfff);
		} else if (!strcmp(argv[0], "-c")) {
			spi_init(0, 1000000, 21, 0, 1, 0);
			while (1) {
				x = spi_xmit(0xd3l << 13) & 0xfff;
				z1 = spi_xmit(0xb3l << 13) & 0xfff;
				z2 = spi_xmit(0xc3l << 13) & 0xfff;
				res = (z2 / z1) - 1;
				res = ((float)x * res) / 4096;
				if ((int)res < 20) {
					y = spi_xmit(0x93l << 13) & 0xfff;
					printf("X = %.3lx\n", x);
					printf("Y = %.3lx\n\n", y);
				}
				if (testc())
					break;
			}
		}
	} else {
		printf("usage:  -r  read coordinates\n");
		printf
		    ("        -c  read coordinates in a loop (press any key to exit)\n");
	}
 
	return 0;
}
 
void module_touch_init(void)
{
	register_command("touch", "", "touch screen utility", touch_cmd);
}