Guillermo Stedile
Forked para SNOCC
Diff: RA8875.cpp
- Revision:
- 78:faf49c381591
- Parent:
- 77:9206c13aa527
- Child:
- 79:544eb4964795
diff -r 9206c13aa527 -r faf49c381591 RA8875.cpp
--- a/RA8875.cpp Fri Dec 26 21:34:28 2014 +0000
+++ b/RA8875.cpp Sun Dec 28 03:14:35 2014 +0000
@@ -161,411 +161,6 @@
return RGBQuadToRGB16(&q, 0);
}
-// ### Touch Panel support code additions begin here
-
-RetCode_t RA8875::TouchPanelInit(void)
-{
- //TPCR0: Set enable bit, default sample time, wakeup, and ADC clock
- WriteCommand(TPCR0, TP_ENABLE | TP_ADC_SAMPLE_DEFAULT_CLKS | TP_ADC_CLKDIV_DEFAULT);
- // TPCR1: Set auto/manual, Ref voltage, debounce, manual mode params
- WriteCommand(TPCR1, TP_MODE_DEFAULT | TP_DEBOUNCE_DEFAULT);
- WriteCommand(INTC1, ReadCommand(INTC1) | RA8875_INT_TP); // reg INTC1: Enable Touch Panel Interrupts (D2 = 1)
- WriteCommand(INTC2, RA8875_INT_TP); // reg INTC2: Clear any TP interrupt flag
- return noerror;
-}
-
-RetCode_t RA8875::TouchPanelInit(uint8_t bTpEnable, uint8_t bTpAutoManual, uint8_t bTpDebounce, uint8_t bTpManualMode, uint8_t bTpAdcClkDiv, uint8_t bTpAdcSampleTime)
-{
- // Parameter bounds check
- if( \
- !(bTpEnable == TP_ENABLE || bTpEnable == TP_ENABLE) || \
- !(bTpAutoManual == TP_MODE_AUTO || bTpAutoManual == TP_MODE_MANUAL) || \
- !(bTpDebounce == TP_DEBOUNCE_OFF || bTpDebounce == TP_DEBOUNCE_ON) || \
- !(bTpManualMode <= TP_MANUAL_LATCH_Y) || \
- !(bTpAdcClkDiv <= TP_ADC_CLKDIV_128) || \
- !(bTpAdcSampleTime <= TP_ADC_SAMPLE_65536_CLKS) \
- ) return bad_parameter;
- // Construct the config byte for TPCR0 and write them
- WriteCommand(TPCR0, bTpEnable | bTpAdcClkDiv | bTpAdcSampleTime); // Note: Wakeup is never enabled
- // Construct the config byte for TPCR1 and write them
- WriteCommand(TPCR1, bTpManualMode | bTpDebounce | bTpManualMode); // Note: Always uses internal Vref.
- // Set up the interrupt flag and enable bits
- WriteCommand(INTC1, ReadCommand(INTC1) | RA8875_INT_TP); // reg INTC1: Enable Touch Panel Interrupts (D2 = 1)
- WriteCommand(INTC2, RA8875_INT_TP); // reg INTC2: Clear any TP interrupt flag
- return noerror;
-}
-
-unsigned char RA8875::TouchPanelRead(loc_t *x, loc_t *y)
-{
- unsigned char touchready;
- static int xbuf[TPBUFSIZE], ybuf[TPBUFSIZE], sample = 0;
- int i, j, temp;
-
- if( (ReadCommand(INTC2) & RA8875_INT_TP) ) { // Test for TP Interrupt pending in register INTC2
- // Get the next data samples
- ybuf[sample] = ReadCommand(TPYH) << 2 | ( (ReadCommand(TPXYL) & 0xC) >> 2 ); // D[9:2] from reg TPYH, D[1:0] from reg TPXYL[3:2]
- xbuf[sample] = ReadCommand(TPXH) << 2 | ( (ReadCommand(TPXYL) & 0x3) ); // D[9:2] from reg TPXH, D[1:0] from reg TPXYL[1:0]
- // Check for a complete set
- if(++sample == TPBUFSIZE) {
- // Buffers are full, so process them using Finn's method described in Analog Dialogue No. 44, Feb 2010
- // This requires sorting the samples in order of size, then discarding the top 25% and
- // bottom 25% as noise spikes. Finally, the middle 50% of the values are averaged to
- // reduce Gaussian noise.
-
- // Sort the Y buffer using an Insertion Sort
- for(i = 1; i <= TPBUFSIZE; i++) {
- temp = ybuf[i];
- j = i;
- while( j && (ybuf[j-1] > temp) ) {
- ybuf[j] = ybuf[j-1];
- j = j-1;
- }
- ybuf[j] = temp;
- } // End of Y sort
- // Sort the X buffer the same way
- for(i = 1; i <= TPBUFSIZE; i++) {
- temp = xbuf[i];
- j = i;
- while( j && (xbuf[j-1] > temp) ) {
- xbuf[j] = xbuf[j-1];
- j = j-1;
- }
- xbuf[j] = temp;
- } // End of X sort
- // Average the middle half of the Y values and report them
- j = 0;
- for(i = (TPBUFSIZE/4) - 1; i < TPBUFSIZE - TPBUFSIZE/4; i++ ) {
- j += ybuf[i];
- }
- *y = j * (float)2/TPBUFSIZE; // This is the average
- // Average the middle half of the X values and report them
- j = 0;
- for(i = (TPBUFSIZE/4) - 1; i < TPBUFSIZE - TPBUFSIZE/4; i++ ) {
- j += xbuf[i];
- }
- *x = j * (float)2/TPBUFSIZE; // This is the average
- // Tidy up and return
- touchready = 1;
- sample = 0; // Ready to start on the next set of data samples
- } else {
- // Buffer not yet full, so do not return any results yet
- touchready = 0;
- }
- WriteCommand(INTC2, RA8875_INT_TP); // reg INTC2: Clear that TP interrupt flag
- } // End of initial if -- data has been read and processed
- else
- touchready = 0; // Touch Panel "Int" was not set
- return touchready;
-}
-
-unsigned char RA8875::TouchPanelReadRaw(loc_t *x, loc_t *y)
-{
- unsigned char touchready;
-
- if( (ReadCommand(INTC2) & RA8875_INT_TP) ) { // Test for TP Interrupt pending in register INTC2
- *y = ReadCommand(TPYH) << 2 | ( (ReadCommand(TPXYL) & 0xC) >> 2 ); // D[9:2] from reg TPYH, D[1:0] from reg TPXYL[3:2]
- *x = ReadCommand(TPXH) << 2 | ( (ReadCommand(TPXYL) & 0x3) ); // D[9:2] from reg TPXH, D[1:0] from reg TPXYL[1:0]
- WriteCommand(INTC2, RA8875_INT_TP); // reg INTC2: Clear that TP interrupt flag
- touchready = 1;
- } else
- touchready = 0;
- return touchready;
-}
-
-/* The following section is derived from Carlos E. Vidales.
- *
- * Copyright (c) 2001, Carlos E. Vidales. All rights reserved.
- *
- * This sample program was written and put in the public domain
- * by Carlos E. Vidales. The program is provided "as is"
- * without warranty of any kind, either expressed or implied.
- * If you choose to use the program within your own products
- * you do so at your own risk, and assume the responsibility
- * for servicing, repairing or correcting the program should
- * it prove defective in any manner.
- * You may copy and distribute the program's source code in any
- * medium, provided that you also include in each copy an
- * appropriate copyright notice and disclaimer of warranty.
- * You may also modify this program and distribute copies of
- * it provided that you include prominent notices stating
- * that you changed the file(s) and the date of any change,
- * and that you do not charge any royalties or licenses for
- * its use.
- *
- * This file contains functions that implement calculations
- * necessary to obtain calibration factors for a touch screen
- * that suffers from multiple distortion effects: namely,
- * translation, scaling and rotation.
- *
- * The following set of equations represent a valid display
- * point given a corresponding set of touch screen points:
- *
- * /- -\
- * /- -\ /- -\ | |
- * | | | | | Xs |
- * | Xd | | A B C | | |
- * | | = | | * | Ys |
- * | Yd | | D E F | | |
- * | | | | | 1 |
- * \- -/ \- -/ | |
- * \- -/
- * where:
- * (Xd,Yd) represents the desired display point
- * coordinates,
- * (Xs,Ys) represents the available touch screen
- * coordinates, and the matrix
- * /- -\
- * |A,B,C|
- * |D,E,F| represents the factors used to translate
- * \- -/ the available touch screen point values
- * into the corresponding display
- * coordinates.
- * Note that for practical considerations, the utilities
- * within this file do not use the matrix coefficients as
- * defined above, but instead use the following
- * equivalents, since floating point math is not used:
- * A = An/Divider
- * B = Bn/Divider
- * C = Cn/Divider
- * D = Dn/Divider
- * E = En/Divider
- * F = Fn/Divider
- * The functions provided within this file are:
- * setCalibrationMatrix() - calculates the set of factors
- * in the above equation, given
- * three sets of test points.
- * getDisplayPoint() - returns the actual display
- * coordinates, given a set of
- * touch screen coordinates.
- * translateRawScreenCoordinates() - helper function to transform
- * raw screen points into values
- * scaled to the desired display
- * resolution.
- */
-
-/**********************************************************************
- *
- * Function: setCalibrationMatrix()
- *
- * Description: Calling this function with valid input data
- * in the display and screen input arguments
- * causes the calibration factors between the
- * screen and display points to be calculated,
- * and the output argument - matrixPtr - to be
- * populated.
- *
- * This function needs to be called only when new
- * calibration factors are desired.
- *
- *
- * Argument(s): displayPtr (input) - Pointer to an array of three
- * sample, reference points.
- * screenPtr (input) - Pointer to the array of touch
- * screen points corresponding
- * to the reference display points.
- * matrixPtr (output) - Pointer to the calibration
- * matrix computed for the set
- * of points being provided.
- *
- *
- * From the article text, recall that the matrix coefficients are
- * resolved to be the following:
- *
- *
- * Divider = (Xs0 - Xs2)*(Ys1 - Ys2) - (Xs1 - Xs2)*(Ys0 - Ys2)
- *
- *
- *
- * (Xd0 - Xd2)*(Ys1 - Ys2) - (Xd1 - Xd2)*(Ys0 - Ys2)
- * A = ---------------------------------------------------
- * Divider
- *
- *
- * (Xs0 - Xs2)*(Xd1 - Xd2) - (Xd0 - Xd2)*(Xs1 - Xs2)
- * B = ---------------------------------------------------
- * Divider
- *
- *
- * Ys0*(Xs2*Xd1 - Xs1*Xd2) +
- * Ys1*(Xs0*Xd2 - Xs2*Xd0) +
- * Ys2*(Xs1*Xd0 - Xs0*Xd1)
- * C = ---------------------------------------------------
- * Divider
- *
- *
- * (Yd0 - Yd2)*(Ys1 - Ys2) - (Yd1 - Yd2)*(Ys0 - Ys2)
- * D = ---------------------------------------------------
- * Divider
- *
- *
- * (Xs0 - Xs2)*(Yd1 - Yd2) - (Yd0 - Yd2)*(Xs1 - Xs2)
- * E = ---------------------------------------------------
- * Divider
- *
- *
- * Ys0*(Xs2*Yd1 - Xs1*Yd2) +
- * Ys1*(Xs0*Yd2 - Xs2*Yd0) +
- * Ys2*(Xs1*Yd0 - Xs0*Yd1)
- * F = ---------------------------------------------------
- * Divider
- *
- *
- * Return: OK - the calibration matrix was correctly
- * calculated and its value is in the
- * output argument.
- * NOT_OK - an error was detected and the
- * function failed to return a valid
- * set of matrix values.
- * The only time this sample code returns
- * NOT_OK is when Divider == 0
- *
- *
- *
- * NOTE! NOTE! NOTE!
- *
- * setCalibrationMatrix() and getDisplayPoint() will do fine
- * for you as they are, provided that your digitizer
- * resolution does not exceed 10 bits (1024 values). Higher
- * resolutions may cause the integer operations to overflow
- * and return incorrect values. If you wish to use these
- * functions with digitizer resolutions of 12 bits (4096
- * values) you will either have to a) use 64-bit signed
- * integer variables and math, or b) judiciously modify the
- * operations to scale results by a factor of 2 or even 4.
- *
- */
-RetCode_t RA8875::TouchPanelCalibrate(point_t * displayPtr, point_t * screenPtr, tpMatrix_t * matrixPtr)
-{
- RetCode_t retValue = noerror;
-
- tpMatrix.Divider = ((screenPtr[0].x - screenPtr[2].x) * (screenPtr[1].y - screenPtr[2].y)) -
- ((screenPtr[1].x - screenPtr[2].x) * (screenPtr[0].y - screenPtr[2].y)) ;
-
- if( tpMatrix.Divider == 0 ) {
- retValue = bad_parameter;
- } else {
- tpMatrix.An = ((displayPtr[0].x - displayPtr[2].x) * (screenPtr[1].y - screenPtr[2].y)) -
- ((displayPtr[1].x - displayPtr[2].x) * (screenPtr[0].y - screenPtr[2].y)) ;
-
- tpMatrix.Bn = ((screenPtr[0].x - screenPtr[2].x) * (displayPtr[1].x - displayPtr[2].x)) -
- ((displayPtr[0].x - displayPtr[2].x) * (screenPtr[1].x - screenPtr[2].x)) ;
-
- tpMatrix.Cn = (screenPtr[2].x * displayPtr[1].x - screenPtr[1].x * displayPtr[2].x) * screenPtr[0].y +
- (screenPtr[0].x * displayPtr[2].x - screenPtr[2].x * displayPtr[0].x) * screenPtr[1].y +
- (screenPtr[1].x * displayPtr[0].x - screenPtr[0].x * displayPtr[1].x) * screenPtr[2].y ;
-
- tpMatrix.Dn = ((displayPtr[0].y - displayPtr[2].y) * (screenPtr[1].y - screenPtr[2].y)) -
- ((displayPtr[1].y - displayPtr[2].y) * (screenPtr[0].y - screenPtr[2].y)) ;
-
- tpMatrix.En = ((screenPtr[0].x - screenPtr[2].x) * (displayPtr[1].y - displayPtr[2].y)) -
- ((displayPtr[0].y - displayPtr[2].y) * (screenPtr[1].x - screenPtr[2].x)) ;
-
- tpMatrix.Fn = (screenPtr[2].x * displayPtr[1].y - screenPtr[1].x * displayPtr[2].y) * screenPtr[0].y +
- (screenPtr[0].x * displayPtr[2].y - screenPtr[2].x * displayPtr[0].y) * screenPtr[1].y +
- (screenPtr[1].x * displayPtr[0].y - screenPtr[0].x * displayPtr[1].y) * screenPtr[2].y ;
- if (matrixPtr)
- memcpy(matrixPtr, &tpMatrix, sizeof(tpMatrix_t));
- }
- return( retValue ) ;
-}
-
-/**********************************************************************
- *
- * Function: getDisplayPoint()
- *
- * Description: Given a valid set of calibration factors and a point
- * value reported by the touch screen, this function
- * calculates and returns the true (or closest to true)
- * display point below the spot where the touch screen
- * was touched.
- *
- *
- *
- * Argument(s): displayPtr (output) - Pointer to the calculated
- * (true) display point.
- * screenPtr (input) - Pointer to the reported touch
- * screen point.
- * matrixPtr (input) - Pointer to calibration factors
- * matrix previously calculated
- * from a call to
- * setCalibrationMatrix()
- *
- *
- * The function simply solves for Xd and Yd by implementing the
- * computations required by the translation matrix.
- *
- * /- -\
- * /- -\ /- -\ | |
- * | | | | | Xs |
- * | Xd | | A B C | | |
- * | | = | | * | Ys |
- * | Yd | | D E F | | |
- * | | | | | 1 |
- * \- -/ \- -/ | |
- * \- -/
- *
- * It must be kept brief to avoid consuming CPU cycles.
- *
- *
- * Return: OK - the display point was correctly calculated
- * and its value is in the output argument.
- * NOT_OK - an error was detected and the function
- * failed to return a valid point.
- *
- *
- *
- * NOTE! NOTE! NOTE!
- *
- * setCalibrationMatrix() and getDisplayPoint() will do fine
- * for you as they are, provided that your digitizer
- * resolution does not exceed 10 bits (1024 values). Higher
- * resolutions may cause the integer operations to overflow
- * and return incorrect values. If you wish to use these
- * functions with digitizer resolutions of 12 bits (4096
- * values) you will either have to a) use 64-bit signed
- * integer variables and math, or b) judiciously modify the
- * operations to scale results by a factor of 2 or even 4.
- *
- */
-RetCode_t RA8875::TouchPanelPoint(point_t * TouchPoint)
-{
- RetCode_t retValue = no_touch;
- point_t screenpoint = {0, 0};
-
- if (TouchPanelReadRaw(&screenpoint.x, &screenpoint.y)) {
- retValue = touch;
- if (tpMatrix.Divider != 0 ) {
- /* Operation order is important since we are doing integer */
- /* math. Make sure you add all terms together before */
- /* dividing, so that the remainder is not rounded off */
- /* prematurely. */
- TouchPoint->x = ( (tpMatrix.An * screenpoint.x) +
- (tpMatrix.Bn * screenpoint.y) +
- tpMatrix.Cn
- ) / tpMatrix.Divider ;
-
- TouchPoint->y = ( (tpMatrix.Dn * screenpoint.x) +
- (tpMatrix.En * screenpoint.y) +
- tpMatrix.Fn
- ) / tpMatrix.Divider ;
- } else {
- retValue = bad_parameter ;
- }
- }
- return( retValue );
-}
-
-
-RetCode_t RA8875::TouchPanelSetMatrix(tpMatrix_t * matrixPtr)
-{
- if (matrixPtr == NULL || matrixPtr->Divider == 0)
- return bad_parameter;
- memcpy(&tpMatrix, matrixPtr, sizeof(tpMatrix_t));
- return noerror;
-}
-
-// #### end of touch panel code additions
-
RetCode_t RA8875::KeypadInit(bool scanEnable, bool longDetect, uint8_t sampleTime, uint8_t scanFrequency,
uint8_t longTimeAdjustment, bool interruptEnable, bool wakeupEnable)
@@ -2597,35 +2192,55 @@
{
Timer t;
loc_t x, y;
-
+ tpMatrix_t calmatrix;
+
display.background(Black);
display.foreground(Blue);
display.cls();
display.puts(0,0, "Touch Panel Test\r\n");
- pc.printf("Touch Panel Test");
+ pc.printf("Touch Panel Test\r\n");
display.TouchPanelInit();
- point_t pTest[3] =
- { { 50, 50 }, {450, 50}, {450,250} };
- point_t pSample[3];
- for (int i=0; i<3; i++) {
- display.foreground(Blue);
- display.printf("(%3d,%3d) => ", pTest[i].x, pTest[i].y);
- display.line(pTest[i].x-10, pTest[i].y, pTest[i].x+10, pTest[i].y, White);
- display.line(pTest[i].x, pTest[i].y-10, pTest[i].x, pTest[i].y+10, White);
- while (!display.TouchPanelReadRaw(&x, &y))
- wait_ms(20);
- pSample[i].x = x;
- pSample[i].y = y;
- display.line(pTest[i].x-10, pTest[i].y, pTest[i].x+10, pTest[i].y, Black);
- display.line(pTest[i].x, pTest[i].y-10, pTest[i].x, pTest[i].y+10, Black);
- display.foreground(Blue);
- display.printf(" (%4d,%4d)\r\n", x,y);
- while (display.TouchPanelReadRaw(&x, &y))
- wait_ms(20);
- wait(2);
+ pc.printf(" TP: c - calibrate, r - restore, t - test\r\n");
+ int c = pc.getc();
+ if (c == 'c') {
+ point_t pTest[3] =
+ { { 50, 50 }, {450, 150}, {225,250} };
+ point_t pSample[3];
+ for (int i=0; i<3; i++) {
+ display.foreground(Blue);
+ display.printf(" (%3d,%3d) => ", pTest[i].x, pTest[i].y);
+ display.line(pTest[i].x-10, pTest[i].y, pTest[i].x+10, pTest[i].y, White);
+ display.line(pTest[i].x, pTest[i].y-10, pTest[i].x, pTest[i].y+10, White);
+ while (!display.TouchPanelRead(&x, &y))
+ wait_ms(20);
+ pSample[i].x = x;
+ pSample[i].y = y;
+ display.line(pTest[i].x-10, pTest[i].y, pTest[i].x+10, pTest[i].y, Black);
+ display.line(pTest[i].x, pTest[i].y-10, pTest[i].x, pTest[i].y+10, Black);
+ display.foreground(Blue);
+ display.printf(" (%4d,%4d)\r\n", x,y);
+ while (display.TouchPanelRead(&x, &y))
+ wait_ms(20);
+ wait(2);
+ }
+ display.TouchPanelCalibrate(pTest, pSample, &calmatrix);
+ display.printf(" Writing calibration to tpcal.cfg\r\n");
+ FILE * fh = fopen("/local/tpcal.cfg", "wb");
+ if (fh) {
+ fwrite(&calmatrix, sizeof(calmatrix), 1, fh);
+ fclose(fh);
+ }
+ display.printf(" Calibration is complete.");
+ } else if (c == 'r') {
+ display.printf(" Reading calibration from tpcal.cfg\r\n");
+ FILE * fh = fopen("/local/tpcal.cfg", "rb");
+ if (fh) {
+ fread(&calmatrix, sizeof(calmatrix), 1, fh);
+ fclose(fh);
+ }
+ display.printf(" Calibration is complete.");
+ display.TouchPanelSetMatrix(&calmatrix);
}
- display.TouchPanelCalibrate(pTest, pSample, NULL);
- display.printf(" Calibration is complete.");
t.start();
do {
point_t point = {0, 0};
@@ -2670,7 +2285,6 @@
void PrintScreen(RA8875 & display, Serial & pc)
{
- LocalFileSystem local("local");
if (!SuppressSlowStuff)
pc.printf("PrintScreen\r\n");
display.PrintScreen( 0,0, 480,272, "/local/Capture.bmp");