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);
}