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

}