Library to control a Graphics TFT connected to 4-wire SPI - revised for the Raio RA8875 Display Controller.
Dependents: FRDM_RA8875_mPaint RA8875_Demo RA8875_KeyPadDemo SignalGenerator ... more
Fork of SPI_TFT by
See Components - RA8875 Based Display
Enhanced touch-screen support - where it previous supported both the Resistive Touch and Capacitive Touch based on the FT5206 Touch Controller, now it also has support for the GSL1680 Touch Controller.
Offline Help Manual (Windows chm)
/media/uploads/WiredHome/ra8875.zip.bin (download, rename to .zip and unzip)
RA8875_Touch.cpp@88:bfddef6ec836, 2015-01-19 (annotated)
- Committer:
- WiredHome
- Date:
- Mon Jan 19 15:44:41 2015 +0000
- Revision:
- 88:bfddef6ec836
- Parent:
- 85:022bba13c5c4
- Child:
- 103:7e0464ca6c5c
Added a timeout to the touch calibration process, so that it will return if there is no touchscreen, user not present, or a stuck touchscreen.
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
WiredHome | 78:faf49c381591 | 1 | /// This file contains the RA8875 Touch panel methods. |
WiredHome | 78:faf49c381591 | 2 | /// |
WiredHome | 78:faf49c381591 | 3 | |
WiredHome | 78:faf49c381591 | 4 | #include "RA8875.h" |
WiredHome | 78:faf49c381591 | 5 | |
WiredHome | 83:7bad0068cca0 | 6 | #define NOTOUCH_TIMEOUT_uS 100000 |
WiredHome | 83:7bad0068cca0 | 7 | #define TOUCH_TICKER_uS 1000 |
WiredHome | 83:7bad0068cca0 | 8 | |
WiredHome | 78:faf49c381591 | 9 | // ### Touch Panel support code additions begin here |
WiredHome | 78:faf49c381591 | 10 | |
WiredHome | 78:faf49c381591 | 11 | RetCode_t RA8875::TouchPanelInit(void) |
WiredHome | 78:faf49c381591 | 12 | { |
WiredHome | 78:faf49c381591 | 13 | //TPCR0: Set enable bit, default sample time, wakeup, and ADC clock |
WiredHome | 78:faf49c381591 | 14 | WriteCommand(TPCR0, TP_ENABLE | TP_ADC_SAMPLE_DEFAULT_CLKS | TP_ADC_CLKDIV_DEFAULT); |
WiredHome | 78:faf49c381591 | 15 | // TPCR1: Set auto/manual, Ref voltage, debounce, manual mode params |
WiredHome | 78:faf49c381591 | 16 | WriteCommand(TPCR1, TP_MODE_DEFAULT | TP_DEBOUNCE_DEFAULT); |
WiredHome | 78:faf49c381591 | 17 | WriteCommand(INTC1, ReadCommand(INTC1) | RA8875_INT_TP); // reg INTC1: Enable Touch Panel Interrupts (D2 = 1) |
WiredHome | 78:faf49c381591 | 18 | WriteCommand(INTC2, RA8875_INT_TP); // reg INTC2: Clear any TP interrupt flag |
WiredHome | 83:7bad0068cca0 | 19 | touchSample = 0; |
WiredHome | 83:7bad0068cca0 | 20 | touchState = no_cal; |
WiredHome | 83:7bad0068cca0 | 21 | touchTicker.attach_us(this, &RA8875::_TouchTicker, TOUCH_TICKER_uS); |
WiredHome | 83:7bad0068cca0 | 22 | touchTimer.start(); |
WiredHome | 83:7bad0068cca0 | 23 | touchTimer.reset(); |
WiredHome | 78:faf49c381591 | 24 | return noerror; |
WiredHome | 78:faf49c381591 | 25 | } |
WiredHome | 78:faf49c381591 | 26 | |
WiredHome | 78:faf49c381591 | 27 | RetCode_t RA8875::TouchPanelInit(uint8_t bTpEnable, uint8_t bTpAutoManual, uint8_t bTpDebounce, uint8_t bTpManualMode, uint8_t bTpAdcClkDiv, uint8_t bTpAdcSampleTime) |
WiredHome | 78:faf49c381591 | 28 | { |
WiredHome | 78:faf49c381591 | 29 | // Parameter bounds check |
WiredHome | 78:faf49c381591 | 30 | if( \ |
WiredHome | 78:faf49c381591 | 31 | !(bTpEnable == TP_ENABLE || bTpEnable == TP_ENABLE) || \ |
WiredHome | 78:faf49c381591 | 32 | !(bTpAutoManual == TP_MODE_AUTO || bTpAutoManual == TP_MODE_MANUAL) || \ |
WiredHome | 78:faf49c381591 | 33 | !(bTpDebounce == TP_DEBOUNCE_OFF || bTpDebounce == TP_DEBOUNCE_ON) || \ |
WiredHome | 78:faf49c381591 | 34 | !(bTpManualMode <= TP_MANUAL_LATCH_Y) || \ |
WiredHome | 78:faf49c381591 | 35 | !(bTpAdcClkDiv <= TP_ADC_CLKDIV_128) || \ |
WiredHome | 78:faf49c381591 | 36 | !(bTpAdcSampleTime <= TP_ADC_SAMPLE_65536_CLKS) \ |
WiredHome | 78:faf49c381591 | 37 | ) return bad_parameter; |
WiredHome | 78:faf49c381591 | 38 | // Construct the config byte for TPCR0 and write them |
WiredHome | 78:faf49c381591 | 39 | WriteCommand(TPCR0, bTpEnable | bTpAdcClkDiv | bTpAdcSampleTime); // Note: Wakeup is never enabled |
WiredHome | 78:faf49c381591 | 40 | // Construct the config byte for TPCR1 and write them |
WiredHome | 78:faf49c381591 | 41 | WriteCommand(TPCR1, bTpManualMode | bTpDebounce | bTpManualMode); // Note: Always uses internal Vref. |
WiredHome | 78:faf49c381591 | 42 | // Set up the interrupt flag and enable bits |
WiredHome | 78:faf49c381591 | 43 | WriteCommand(INTC1, ReadCommand(INTC1) | RA8875_INT_TP); // reg INTC1: Enable Touch Panel Interrupts (D2 = 1) |
WiredHome | 78:faf49c381591 | 44 | WriteCommand(INTC2, RA8875_INT_TP); // reg INTC2: Clear any TP interrupt flag |
WiredHome | 83:7bad0068cca0 | 45 | touchSample = 0; |
WiredHome | 83:7bad0068cca0 | 46 | touchState = no_cal; |
WiredHome | 83:7bad0068cca0 | 47 | if (bTpEnable == TP_ENABLE) { |
WiredHome | 83:7bad0068cca0 | 48 | touchTicker.attach_us(this, &RA8875::_TouchTicker, TOUCH_TICKER_uS); |
WiredHome | 83:7bad0068cca0 | 49 | touchTimer.start(); |
WiredHome | 83:7bad0068cca0 | 50 | touchTimer.reset(); |
WiredHome | 83:7bad0068cca0 | 51 | } else { |
WiredHome | 83:7bad0068cca0 | 52 | touchTicker.detach(); |
WiredHome | 83:7bad0068cca0 | 53 | touchTimer.stop(); |
WiredHome | 83:7bad0068cca0 | 54 | } |
WiredHome | 78:faf49c381591 | 55 | return noerror; |
WiredHome | 78:faf49c381591 | 56 | } |
WiredHome | 78:faf49c381591 | 57 | |
WiredHome | 81:01da2e34283d | 58 | // +----------------------------------------------------+ |
WiredHome | 81:01da2e34283d | 59 | // | | |
WiredHome | 81:01da2e34283d | 60 | // | 1 | |
WiredHome | 81:01da2e34283d | 61 | // | | |
WiredHome | 81:01da2e34283d | 62 | // | | |
WiredHome | 81:01da2e34283d | 63 | // | 2 | |
WiredHome | 81:01da2e34283d | 64 | // | | |
WiredHome | 81:01da2e34283d | 65 | // | | |
WiredHome | 81:01da2e34283d | 66 | // | 3 | |
WiredHome | 81:01da2e34283d | 67 | // | | |
WiredHome | 81:01da2e34283d | 68 | // +----------------------------------------------------+ |
WiredHome | 81:01da2e34283d | 69 | |
WiredHome | 81:01da2e34283d | 70 | |
WiredHome | 81:01da2e34283d | 71 | RetCode_t RA8875::TouchPanelCalibrate(tpMatrix_t * matrix) |
WiredHome | 81:01da2e34283d | 72 | { |
WiredHome | 81:01da2e34283d | 73 | return TouchPanelCalibrate(NULL, matrix); |
WiredHome | 81:01da2e34283d | 74 | } |
WiredHome | 81:01da2e34283d | 75 | |
WiredHome | 81:01da2e34283d | 76 | |
WiredHome | 88:bfddef6ec836 | 77 | RetCode_t RA8875::TouchPanelCalibrate(const char * msg, tpMatrix_t * matrix, int maxwait_s) |
WiredHome | 81:01da2e34283d | 78 | { |
WiredHome | 81:01da2e34283d | 79 | point_t pTest[3]; |
WiredHome | 81:01da2e34283d | 80 | point_t pSample[3]; |
WiredHome | 83:7bad0068cca0 | 81 | int x,y; |
WiredHome | 88:bfddef6ec836 | 82 | Timer timeout; // timeout guards for not-installed, stuck, user not present... |
WiredHome | 81:01da2e34283d | 83 | |
WiredHome | 88:bfddef6ec836 | 84 | timeout.start(); |
WiredHome | 88:bfddef6ec836 | 85 | while (TouchPanelA2DFiltered(&x, &y) && timeout.read() < maxwait_s) |
WiredHome | 83:7bad0068cca0 | 86 | wait_ms(20); |
WiredHome | 81:01da2e34283d | 87 | cls(); |
WiredHome | 81:01da2e34283d | 88 | if (msg) |
WiredHome | 81:01da2e34283d | 89 | puts(msg); |
WiredHome | 81:01da2e34283d | 90 | SetTextCursor(0,height()/2); |
WiredHome | 81:01da2e34283d | 91 | pTest[0].x = 50; pTest[0].y = 50; |
WiredHome | 81:01da2e34283d | 92 | pTest[1].x = width() - 50; pTest[1].y = height()/2; |
WiredHome | 81:01da2e34283d | 93 | pTest[2].x = width()/2; pTest[2].y = height() - 50; |
WiredHome | 88:bfddef6ec836 | 94 | |
WiredHome | 81:01da2e34283d | 95 | for (int i=0; i<3; i++) { |
WiredHome | 81:01da2e34283d | 96 | foreground(Blue); |
WiredHome | 81:01da2e34283d | 97 | printf(" (%3d,%3d) => ", pTest[i].x, pTest[i].y); |
WiredHome | 81:01da2e34283d | 98 | line(pTest[i].x-10, pTest[i].y, pTest[i].x+10, pTest[i].y, White); |
WiredHome | 81:01da2e34283d | 99 | line(pTest[i].x, pTest[i].y-10, pTest[i].x, pTest[i].y+10, White); |
WiredHome | 88:bfddef6ec836 | 100 | while (!TouchPanelA2DFiltered(&x, &y) && timeout.read() < maxwait_s) |
WiredHome | 81:01da2e34283d | 101 | wait_ms(20); |
WiredHome | 81:01da2e34283d | 102 | pSample[i].x = x; |
WiredHome | 81:01da2e34283d | 103 | pSample[i].y = y; |
WiredHome | 81:01da2e34283d | 104 | line(pTest[i].x-10, pTest[i].y, pTest[i].x+10, pTest[i].y, Black); |
WiredHome | 81:01da2e34283d | 105 | line(pTest[i].x, pTest[i].y-10, pTest[i].x, pTest[i].y+10, Black); |
WiredHome | 81:01da2e34283d | 106 | foreground(Blue); |
WiredHome | 81:01da2e34283d | 107 | printf(" (%4d,%4d)\r\n", x,y); |
WiredHome | 88:bfddef6ec836 | 108 | while (TouchPanelA2DFiltered(&x, &y) && timeout.read() < maxwait_s) |
WiredHome | 81:01da2e34283d | 109 | wait_ms(20); |
WiredHome | 81:01da2e34283d | 110 | wait(2); |
WiredHome | 81:01da2e34283d | 111 | } |
WiredHome | 88:bfddef6ec836 | 112 | if (timeout.read() >= maxwait_s) |
WiredHome | 88:bfddef6ec836 | 113 | return touch_cal_timeout; |
WiredHome | 88:bfddef6ec836 | 114 | else |
WiredHome | 88:bfddef6ec836 | 115 | return TouchPanelComputeCalibration(pTest, pSample, matrix); |
WiredHome | 81:01da2e34283d | 116 | } |
WiredHome | 81:01da2e34283d | 117 | |
WiredHome | 81:01da2e34283d | 118 | |
WiredHome | 81:01da2e34283d | 119 | /********************************************************************** |
WiredHome | 81:01da2e34283d | 120 | * |
WiredHome | 81:01da2e34283d | 121 | * Function: getDisplayPoint() |
WiredHome | 81:01da2e34283d | 122 | * |
WiredHome | 81:01da2e34283d | 123 | * Description: Given a valid set of calibration factors and a point |
WiredHome | 81:01da2e34283d | 124 | * value reported by the touch screen, this function |
WiredHome | 81:01da2e34283d | 125 | * calculates and returns the true (or closest to true) |
WiredHome | 81:01da2e34283d | 126 | * display point below the spot where the touch screen |
WiredHome | 81:01da2e34283d | 127 | * was touched. |
WiredHome | 81:01da2e34283d | 128 | * |
WiredHome | 81:01da2e34283d | 129 | * |
WiredHome | 81:01da2e34283d | 130 | * |
WiredHome | 81:01da2e34283d | 131 | * Argument(s): displayPtr (output) - Pointer to the calculated |
WiredHome | 81:01da2e34283d | 132 | * (true) display point. |
WiredHome | 81:01da2e34283d | 133 | * screenPtr (input) - Pointer to the reported touch |
WiredHome | 81:01da2e34283d | 134 | * screen point. |
WiredHome | 81:01da2e34283d | 135 | * matrixPtr (input) - Pointer to calibration factors |
WiredHome | 81:01da2e34283d | 136 | * matrix previously calculated |
WiredHome | 81:01da2e34283d | 137 | * from a call to |
WiredHome | 81:01da2e34283d | 138 | * setCalibrationMatrix() |
WiredHome | 81:01da2e34283d | 139 | * |
WiredHome | 81:01da2e34283d | 140 | * |
WiredHome | 81:01da2e34283d | 141 | * The function simply solves for Xd and Yd by implementing the |
WiredHome | 81:01da2e34283d | 142 | * computations required by the translation matrix. |
WiredHome | 81:01da2e34283d | 143 | * |
WiredHome | 81:01da2e34283d | 144 | * /- -\ |
WiredHome | 81:01da2e34283d | 145 | * /- -\ /- -\ | | |
WiredHome | 81:01da2e34283d | 146 | * | | | | | Xs | |
WiredHome | 81:01da2e34283d | 147 | * | Xd | | A B C | | | |
WiredHome | 81:01da2e34283d | 148 | * | | = | | * | Ys | |
WiredHome | 81:01da2e34283d | 149 | * | Yd | | D E F | | | |
WiredHome | 81:01da2e34283d | 150 | * | | | | | 1 | |
WiredHome | 81:01da2e34283d | 151 | * \- -/ \- -/ | | |
WiredHome | 81:01da2e34283d | 152 | * \- -/ |
WiredHome | 81:01da2e34283d | 153 | * |
WiredHome | 81:01da2e34283d | 154 | * It must be kept brief to avoid consuming CPU cycles. |
WiredHome | 81:01da2e34283d | 155 | * |
WiredHome | 81:01da2e34283d | 156 | * Return: OK - the display point was correctly calculated |
WiredHome | 81:01da2e34283d | 157 | * and its value is in the output argument. |
WiredHome | 81:01da2e34283d | 158 | * NOT_OK - an error was detected and the function |
WiredHome | 81:01da2e34283d | 159 | * failed to return a valid point. |
WiredHome | 81:01da2e34283d | 160 | * |
WiredHome | 81:01da2e34283d | 161 | * NOTE! NOTE! NOTE! |
WiredHome | 81:01da2e34283d | 162 | * |
WiredHome | 81:01da2e34283d | 163 | * setCalibrationMatrix() and getDisplayPoint() will do fine |
WiredHome | 81:01da2e34283d | 164 | * for you as they are, provided that your digitizer |
WiredHome | 81:01da2e34283d | 165 | * resolution does not exceed 10 bits (1024 values). Higher |
WiredHome | 81:01da2e34283d | 166 | * resolutions may cause the integer operations to overflow |
WiredHome | 81:01da2e34283d | 167 | * and return incorrect values. If you wish to use these |
WiredHome | 81:01da2e34283d | 168 | * functions with digitizer resolutions of 12 bits (4096 |
WiredHome | 81:01da2e34283d | 169 | * values) you will either have to a) use 64-bit signed |
WiredHome | 81:01da2e34283d | 170 | * integer variables and math, or b) judiciously modify the |
WiredHome | 81:01da2e34283d | 171 | * operations to scale results by a factor of 2 or even 4. |
WiredHome | 81:01da2e34283d | 172 | * |
WiredHome | 81:01da2e34283d | 173 | */ |
WiredHome | 83:7bad0068cca0 | 174 | TouchCode_t RA8875::TouchPanelReadable(point_t * TouchPoint) |
WiredHome | 81:01da2e34283d | 175 | { |
WiredHome | 83:7bad0068cca0 | 176 | int a2dX = 0; |
WiredHome | 83:7bad0068cca0 | 177 | int a2dY = 0; |
WiredHome | 81:01da2e34283d | 178 | |
WiredHome | 83:7bad0068cca0 | 179 | TouchCode_t ts = TouchPanelA2DFiltered(&a2dX, &a2dY); |
WiredHome | 83:7bad0068cca0 | 180 | if (ts != no_touch) { |
WiredHome | 81:01da2e34283d | 181 | if (tpMatrix.Divider != 0 && TouchPoint) { |
WiredHome | 81:01da2e34283d | 182 | /* Operation order is important since we are doing integer */ |
WiredHome | 81:01da2e34283d | 183 | /* math. Make sure you add all terms together before */ |
WiredHome | 81:01da2e34283d | 184 | /* dividing, so that the remainder is not rounded off */ |
WiredHome | 81:01da2e34283d | 185 | /* prematurely. */ |
WiredHome | 83:7bad0068cca0 | 186 | TouchPoint->x = ( (tpMatrix.An * a2dX) + |
WiredHome | 83:7bad0068cca0 | 187 | (tpMatrix.Bn * a2dY) + |
WiredHome | 81:01da2e34283d | 188 | tpMatrix.Cn |
WiredHome | 81:01da2e34283d | 189 | ) / tpMatrix.Divider ; |
WiredHome | 81:01da2e34283d | 190 | |
WiredHome | 83:7bad0068cca0 | 191 | TouchPoint->y = ( (tpMatrix.Dn * a2dX) + |
WiredHome | 83:7bad0068cca0 | 192 | (tpMatrix.En * a2dY) + |
WiredHome | 81:01da2e34283d | 193 | tpMatrix.Fn |
WiredHome | 81:01da2e34283d | 194 | ) / tpMatrix.Divider ; |
WiredHome | 81:01da2e34283d | 195 | } else { |
WiredHome | 83:7bad0068cca0 | 196 | ts = no_cal; |
WiredHome | 81:01da2e34283d | 197 | } |
WiredHome | 81:01da2e34283d | 198 | } |
WiredHome | 83:7bad0068cca0 | 199 | return ts; |
WiredHome | 81:01da2e34283d | 200 | } |
WiredHome | 81:01da2e34283d | 201 | |
WiredHome | 81:01da2e34283d | 202 | |
WiredHome | 85:022bba13c5c4 | 203 | TouchCode_t RA8875::TouchPanelGet(point_t * TouchPoint) |
WiredHome | 85:022bba13c5c4 | 204 | { |
WiredHome | 85:022bba13c5c4 | 205 | TouchCode_t t; |
WiredHome | 85:022bba13c5c4 | 206 | |
WiredHome | 85:022bba13c5c4 | 207 | do { |
WiredHome | 85:022bba13c5c4 | 208 | t = TouchPanelReadable(TouchPoint); |
WiredHome | 85:022bba13c5c4 | 209 | } while (t == no_touch); |
WiredHome | 85:022bba13c5c4 | 210 | return t; |
WiredHome | 85:022bba13c5c4 | 211 | } |
WiredHome | 85:022bba13c5c4 | 212 | |
WiredHome | 81:01da2e34283d | 213 | RetCode_t RA8875::TouchPanelSetMatrix(tpMatrix_t * matrixPtr) |
WiredHome | 81:01da2e34283d | 214 | { |
WiredHome | 81:01da2e34283d | 215 | if (matrixPtr == NULL || matrixPtr->Divider == 0) |
WiredHome | 81:01da2e34283d | 216 | return bad_parameter; |
WiredHome | 81:01da2e34283d | 217 | memcpy(&tpMatrix, matrixPtr, sizeof(tpMatrix_t)); |
WiredHome | 83:7bad0068cca0 | 218 | touchState = no_touch; |
WiredHome | 81:01da2e34283d | 219 | return noerror; |
WiredHome | 81:01da2e34283d | 220 | } |
WiredHome | 81:01da2e34283d | 221 | |
WiredHome | 81:01da2e34283d | 222 | |
WiredHome | 83:7bad0068cca0 | 223 | static void InsertionSort(int * buf, int bufsize) |
WiredHome | 83:7bad0068cca0 | 224 | { |
WiredHome | 83:7bad0068cca0 | 225 | int i, j; |
WiredHome | 83:7bad0068cca0 | 226 | int temp; |
WiredHome | 83:7bad0068cca0 | 227 | |
WiredHome | 83:7bad0068cca0 | 228 | for(i = 1; i <= bufsize; i++) { |
WiredHome | 83:7bad0068cca0 | 229 | temp = buf[i]; |
WiredHome | 83:7bad0068cca0 | 230 | j = i; |
WiredHome | 83:7bad0068cca0 | 231 | while( j && (buf[j-1] > temp) ) { |
WiredHome | 83:7bad0068cca0 | 232 | buf[j] = buf[j-1]; |
WiredHome | 83:7bad0068cca0 | 233 | j = j-1; |
WiredHome | 83:7bad0068cca0 | 234 | } |
WiredHome | 83:7bad0068cca0 | 235 | buf[j] = temp; |
WiredHome | 83:7bad0068cca0 | 236 | } // End of sort |
WiredHome | 83:7bad0068cca0 | 237 | } |
WiredHome | 83:7bad0068cca0 | 238 | |
WiredHome | 83:7bad0068cca0 | 239 | |
WiredHome | 83:7bad0068cca0 | 240 | void RA8875::_TouchTicker(void) |
WiredHome | 78:faf49c381591 | 241 | { |
WiredHome | 83:7bad0068cca0 | 242 | if (touchTimer.read_us() > NOTOUCH_TIMEOUT_uS) { |
WiredHome | 83:7bad0068cca0 | 243 | touchSample = 0; |
WiredHome | 83:7bad0068cca0 | 244 | if (touchState == held) |
WiredHome | 83:7bad0068cca0 | 245 | touchState = release; |
WiredHome | 83:7bad0068cca0 | 246 | else |
WiredHome | 83:7bad0068cca0 | 247 | touchState = no_touch; |
WiredHome | 83:7bad0068cca0 | 248 | touchTimer.reset(); |
WiredHome | 83:7bad0068cca0 | 249 | } |
WiredHome | 83:7bad0068cca0 | 250 | } |
WiredHome | 83:7bad0068cca0 | 251 | |
WiredHome | 83:7bad0068cca0 | 252 | TouchCode_t RA8875::TouchPanelA2DRaw(int *x, int *y) |
WiredHome | 83:7bad0068cca0 | 253 | { |
WiredHome | 83:7bad0068cca0 | 254 | if( (ReadCommand(INTC2) & RA8875_INT_TP) ) { // Test for TP Interrupt pending in register INTC2 |
WiredHome | 83:7bad0068cca0 | 255 | touchTimer.reset(); |
WiredHome | 83:7bad0068cca0 | 256 | *y = ReadCommand(TPYH) << 2 | ( (ReadCommand(TPXYL) & 0xC) >> 2 ); // D[9:2] from reg TPYH, D[1:0] from reg TPXYL[3:2] |
WiredHome | 83:7bad0068cca0 | 257 | *x = ReadCommand(TPXH) << 2 | ( (ReadCommand(TPXYL) & 0x3) ); // D[9:2] from reg TPXH, D[1:0] from reg TPXYL[1:0] |
WiredHome | 83:7bad0068cca0 | 258 | WriteCommand(INTC2, RA8875_INT_TP); // reg INTC2: Clear that TP interrupt flag |
WiredHome | 83:7bad0068cca0 | 259 | touchState = touch; |
WiredHome | 83:7bad0068cca0 | 260 | } else { |
WiredHome | 83:7bad0068cca0 | 261 | touchState = no_touch; |
WiredHome | 83:7bad0068cca0 | 262 | } |
WiredHome | 83:7bad0068cca0 | 263 | return touchState; |
WiredHome | 83:7bad0068cca0 | 264 | } |
WiredHome | 83:7bad0068cca0 | 265 | |
WiredHome | 83:7bad0068cca0 | 266 | TouchCode_t RA8875::TouchPanelA2DFiltered(int *x, int *y) |
WiredHome | 83:7bad0068cca0 | 267 | { |
WiredHome | 83:7bad0068cca0 | 268 | static int xbuf[TPBUFSIZE], ybuf[TPBUFSIZE]; |
WiredHome | 83:7bad0068cca0 | 269 | static int lastX, lastY; |
WiredHome | 83:7bad0068cca0 | 270 | int i, j; |
WiredHome | 83:7bad0068cca0 | 271 | TouchCode_t ret = touchState; |
WiredHome | 78:faf49c381591 | 272 | |
WiredHome | 78:faf49c381591 | 273 | if( (ReadCommand(INTC2) & RA8875_INT_TP) ) { // Test for TP Interrupt pending in register INTC2 |
WiredHome | 83:7bad0068cca0 | 274 | touchTimer.reset(); |
WiredHome | 78:faf49c381591 | 275 | // Get the next data samples |
WiredHome | 83:7bad0068cca0 | 276 | ybuf[touchSample] = ReadCommand(TPYH) << 2 | ( (ReadCommand(TPXYL) & 0xC) >> 2 ); // D[9:2] from reg TPYH, D[1:0] from reg TPXYL[3:2] |
WiredHome | 83:7bad0068cca0 | 277 | xbuf[touchSample] = ReadCommand(TPXH) << 2 | ( (ReadCommand(TPXYL) & 0x3) ); // D[9:2] from reg TPXH, D[1:0] from reg TPXYL[1:0] |
WiredHome | 78:faf49c381591 | 278 | // Check for a complete set |
WiredHome | 83:7bad0068cca0 | 279 | if(++touchSample == TPBUFSIZE) { |
WiredHome | 78:faf49c381591 | 280 | // Buffers are full, so process them using Finn's method described in Analog Dialogue No. 44, Feb 2010 |
WiredHome | 78:faf49c381591 | 281 | // This requires sorting the samples in order of size, then discarding the top 25% and |
WiredHome | 78:faf49c381591 | 282 | // bottom 25% as noise spikes. Finally, the middle 50% of the values are averaged to |
WiredHome | 78:faf49c381591 | 283 | // reduce Gaussian noise. |
WiredHome | 83:7bad0068cca0 | 284 | #if 1 |
WiredHome | 83:7bad0068cca0 | 285 | InsertionSort(ybuf, TPBUFSIZE); |
WiredHome | 83:7bad0068cca0 | 286 | InsertionSort(xbuf, TPBUFSIZE); |
WiredHome | 83:7bad0068cca0 | 287 | #else |
WiredHome | 78:faf49c381591 | 288 | // Sort the Y buffer using an Insertion Sort |
WiredHome | 78:faf49c381591 | 289 | for(i = 1; i <= TPBUFSIZE; i++) { |
WiredHome | 78:faf49c381591 | 290 | temp = ybuf[i]; |
WiredHome | 78:faf49c381591 | 291 | j = i; |
WiredHome | 78:faf49c381591 | 292 | while( j && (ybuf[j-1] > temp) ) { |
WiredHome | 78:faf49c381591 | 293 | ybuf[j] = ybuf[j-1]; |
WiredHome | 78:faf49c381591 | 294 | j = j-1; |
WiredHome | 78:faf49c381591 | 295 | } |
WiredHome | 78:faf49c381591 | 296 | ybuf[j] = temp; |
WiredHome | 78:faf49c381591 | 297 | } // End of Y sort |
WiredHome | 78:faf49c381591 | 298 | // Sort the X buffer the same way |
WiredHome | 78:faf49c381591 | 299 | for(i = 1; i <= TPBUFSIZE; i++) { |
WiredHome | 78:faf49c381591 | 300 | temp = xbuf[i]; |
WiredHome | 78:faf49c381591 | 301 | j = i; |
WiredHome | 78:faf49c381591 | 302 | while( j && (xbuf[j-1] > temp) ) { |
WiredHome | 78:faf49c381591 | 303 | xbuf[j] = xbuf[j-1]; |
WiredHome | 78:faf49c381591 | 304 | j = j-1; |
WiredHome | 78:faf49c381591 | 305 | } |
WiredHome | 78:faf49c381591 | 306 | xbuf[j] = temp; |
WiredHome | 78:faf49c381591 | 307 | } // End of X sort |
WiredHome | 83:7bad0068cca0 | 308 | #endif |
WiredHome | 78:faf49c381591 | 309 | // Average the middle half of the Y values and report them |
WiredHome | 78:faf49c381591 | 310 | j = 0; |
WiredHome | 78:faf49c381591 | 311 | for(i = (TPBUFSIZE/4) - 1; i < TPBUFSIZE - TPBUFSIZE/4; i++ ) { |
WiredHome | 78:faf49c381591 | 312 | j += ybuf[i]; |
WiredHome | 78:faf49c381591 | 313 | } |
WiredHome | 83:7bad0068cca0 | 314 | *y = lastY = j * (float)2/TPBUFSIZE; // This is the average |
WiredHome | 78:faf49c381591 | 315 | // Average the middle half of the X values and report them |
WiredHome | 78:faf49c381591 | 316 | j = 0; |
WiredHome | 78:faf49c381591 | 317 | for(i = (TPBUFSIZE/4) - 1; i < TPBUFSIZE - TPBUFSIZE/4; i++ ) { |
WiredHome | 78:faf49c381591 | 318 | j += xbuf[i]; |
WiredHome | 78:faf49c381591 | 319 | } |
WiredHome | 83:7bad0068cca0 | 320 | *x = lastX = j * (float)2/TPBUFSIZE; // This is the average |
WiredHome | 78:faf49c381591 | 321 | // Tidy up and return |
WiredHome | 83:7bad0068cca0 | 322 | if (touchState == touch || touchState == held) |
WiredHome | 83:7bad0068cca0 | 323 | touchState = held; |
WiredHome | 83:7bad0068cca0 | 324 | else |
WiredHome | 83:7bad0068cca0 | 325 | touchState = touch; |
WiredHome | 83:7bad0068cca0 | 326 | ret = touchState; |
WiredHome | 83:7bad0068cca0 | 327 | touchSample = 0; // Ready to start on the next set of data samples |
WiredHome | 78:faf49c381591 | 328 | } else { |
WiredHome | 78:faf49c381591 | 329 | // Buffer not yet full, so do not return any results yet |
WiredHome | 83:7bad0068cca0 | 330 | if (touchState == touch || touchState == held) { |
WiredHome | 83:7bad0068cca0 | 331 | *x = lastX; |
WiredHome | 83:7bad0068cca0 | 332 | *y = lastY; |
WiredHome | 83:7bad0068cca0 | 333 | ret = touchState = held; |
WiredHome | 83:7bad0068cca0 | 334 | } |
WiredHome | 78:faf49c381591 | 335 | } |
WiredHome | 78:faf49c381591 | 336 | WriteCommand(INTC2, RA8875_INT_TP); // reg INTC2: Clear that TP interrupt flag |
WiredHome | 78:faf49c381591 | 337 | } // End of initial if -- data has been read and processed |
WiredHome | 83:7bad0068cca0 | 338 | else { |
WiredHome | 83:7bad0068cca0 | 339 | if (touchState == touch || touchState == held) { |
WiredHome | 83:7bad0068cca0 | 340 | *x = lastX; |
WiredHome | 83:7bad0068cca0 | 341 | *y = lastY; |
WiredHome | 83:7bad0068cca0 | 342 | ret = touchState = held; |
WiredHome | 83:7bad0068cca0 | 343 | } else if (touchState == release) { |
WiredHome | 83:7bad0068cca0 | 344 | *x = lastX; |
WiredHome | 83:7bad0068cca0 | 345 | *y = lastY; |
WiredHome | 83:7bad0068cca0 | 346 | ret = release; |
WiredHome | 83:7bad0068cca0 | 347 | touchState = no_touch; |
WiredHome | 83:7bad0068cca0 | 348 | } |
WiredHome | 83:7bad0068cca0 | 349 | } |
WiredHome | 83:7bad0068cca0 | 350 | return ret; |
WiredHome | 78:faf49c381591 | 351 | } |
WiredHome | 78:faf49c381591 | 352 | |
WiredHome | 78:faf49c381591 | 353 | /* The following section is derived from Carlos E. Vidales. |
WiredHome | 78:faf49c381591 | 354 | * |
WiredHome | 78:faf49c381591 | 355 | * Copyright (c) 2001, Carlos E. Vidales. All rights reserved. |
WiredHome | 78:faf49c381591 | 356 | * |
WiredHome | 78:faf49c381591 | 357 | * This sample program was written and put in the public domain |
WiredHome | 78:faf49c381591 | 358 | * by Carlos E. Vidales. The program is provided "as is" |
WiredHome | 78:faf49c381591 | 359 | * without warranty of any kind, either expressed or implied. |
WiredHome | 78:faf49c381591 | 360 | * If you choose to use the program within your own products |
WiredHome | 78:faf49c381591 | 361 | * you do so at your own risk, and assume the responsibility |
WiredHome | 78:faf49c381591 | 362 | * for servicing, repairing or correcting the program should |
WiredHome | 78:faf49c381591 | 363 | * it prove defective in any manner. |
WiredHome | 78:faf49c381591 | 364 | * You may copy and distribute the program's source code in any |
WiredHome | 78:faf49c381591 | 365 | * medium, provided that you also include in each copy an |
WiredHome | 78:faf49c381591 | 366 | * appropriate copyright notice and disclaimer of warranty. |
WiredHome | 78:faf49c381591 | 367 | * You may also modify this program and distribute copies of |
WiredHome | 78:faf49c381591 | 368 | * it provided that you include prominent notices stating |
WiredHome | 78:faf49c381591 | 369 | * that you changed the file(s) and the date of any change, |
WiredHome | 78:faf49c381591 | 370 | * and that you do not charge any royalties or licenses for |
WiredHome | 78:faf49c381591 | 371 | * its use. |
WiredHome | 78:faf49c381591 | 372 | * |
WiredHome | 78:faf49c381591 | 373 | * This file contains functions that implement calculations |
WiredHome | 78:faf49c381591 | 374 | * necessary to obtain calibration factors for a touch screen |
WiredHome | 78:faf49c381591 | 375 | * that suffers from multiple distortion effects: namely, |
WiredHome | 78:faf49c381591 | 376 | * translation, scaling and rotation. |
WiredHome | 78:faf49c381591 | 377 | * |
WiredHome | 78:faf49c381591 | 378 | * The following set of equations represent a valid display |
WiredHome | 78:faf49c381591 | 379 | * point given a corresponding set of touch screen points: |
WiredHome | 78:faf49c381591 | 380 | * |
WiredHome | 78:faf49c381591 | 381 | * /- -\ |
WiredHome | 78:faf49c381591 | 382 | * /- -\ /- -\ | | |
WiredHome | 78:faf49c381591 | 383 | * | | | | | Xs | |
WiredHome | 78:faf49c381591 | 384 | * | Xd | | A B C | | | |
WiredHome | 78:faf49c381591 | 385 | * | | = | | * | Ys | |
WiredHome | 78:faf49c381591 | 386 | * | Yd | | D E F | | | |
WiredHome | 78:faf49c381591 | 387 | * | | | | | 1 | |
WiredHome | 78:faf49c381591 | 388 | * \- -/ \- -/ | | |
WiredHome | 78:faf49c381591 | 389 | * \- -/ |
WiredHome | 78:faf49c381591 | 390 | * where: |
WiredHome | 78:faf49c381591 | 391 | * (Xd,Yd) represents the desired display point |
WiredHome | 78:faf49c381591 | 392 | * coordinates, |
WiredHome | 78:faf49c381591 | 393 | * (Xs,Ys) represents the available touch screen |
WiredHome | 78:faf49c381591 | 394 | * coordinates, and the matrix |
WiredHome | 78:faf49c381591 | 395 | * /- -\ |
WiredHome | 78:faf49c381591 | 396 | * |A,B,C| |
WiredHome | 78:faf49c381591 | 397 | * |D,E,F| represents the factors used to translate |
WiredHome | 78:faf49c381591 | 398 | * \- -/ the available touch screen point values |
WiredHome | 78:faf49c381591 | 399 | * into the corresponding display |
WiredHome | 78:faf49c381591 | 400 | * coordinates. |
WiredHome | 78:faf49c381591 | 401 | * Note that for practical considerations, the utilities |
WiredHome | 78:faf49c381591 | 402 | * within this file do not use the matrix coefficients as |
WiredHome | 78:faf49c381591 | 403 | * defined above, but instead use the following |
WiredHome | 78:faf49c381591 | 404 | * equivalents, since floating point math is not used: |
WiredHome | 78:faf49c381591 | 405 | * A = An/Divider |
WiredHome | 78:faf49c381591 | 406 | * B = Bn/Divider |
WiredHome | 78:faf49c381591 | 407 | * C = Cn/Divider |
WiredHome | 78:faf49c381591 | 408 | * D = Dn/Divider |
WiredHome | 78:faf49c381591 | 409 | * E = En/Divider |
WiredHome | 78:faf49c381591 | 410 | * F = Fn/Divider |
WiredHome | 78:faf49c381591 | 411 | * The functions provided within this file are: |
WiredHome | 78:faf49c381591 | 412 | * setCalibrationMatrix() - calculates the set of factors |
WiredHome | 78:faf49c381591 | 413 | * in the above equation, given |
WiredHome | 78:faf49c381591 | 414 | * three sets of test points. |
WiredHome | 78:faf49c381591 | 415 | * getDisplayPoint() - returns the actual display |
WiredHome | 78:faf49c381591 | 416 | * coordinates, given a set of |
WiredHome | 78:faf49c381591 | 417 | * touch screen coordinates. |
WiredHome | 78:faf49c381591 | 418 | * translateRawScreenCoordinates() - helper function to transform |
WiredHome | 78:faf49c381591 | 419 | * raw screen points into values |
WiredHome | 78:faf49c381591 | 420 | * scaled to the desired display |
WiredHome | 78:faf49c381591 | 421 | * resolution. |
WiredHome | 78:faf49c381591 | 422 | */ |
WiredHome | 78:faf49c381591 | 423 | |
WiredHome | 78:faf49c381591 | 424 | /********************************************************************** |
WiredHome | 78:faf49c381591 | 425 | * |
WiredHome | 78:faf49c381591 | 426 | * Function: setCalibrationMatrix() |
WiredHome | 78:faf49c381591 | 427 | * |
WiredHome | 78:faf49c381591 | 428 | * Description: Calling this function with valid input data |
WiredHome | 78:faf49c381591 | 429 | * in the display and screen input arguments |
WiredHome | 78:faf49c381591 | 430 | * causes the calibration factors between the |
WiredHome | 78:faf49c381591 | 431 | * screen and display points to be calculated, |
WiredHome | 78:faf49c381591 | 432 | * and the output argument - matrixPtr - to be |
WiredHome | 78:faf49c381591 | 433 | * populated. |
WiredHome | 78:faf49c381591 | 434 | * |
WiredHome | 78:faf49c381591 | 435 | * This function needs to be called only when new |
WiredHome | 78:faf49c381591 | 436 | * calibration factors are desired. |
WiredHome | 78:faf49c381591 | 437 | * |
WiredHome | 78:faf49c381591 | 438 | * |
WiredHome | 78:faf49c381591 | 439 | * Argument(s): displayPtr (input) - Pointer to an array of three |
WiredHome | 78:faf49c381591 | 440 | * sample, reference points. |
WiredHome | 78:faf49c381591 | 441 | * screenPtr (input) - Pointer to the array of touch |
WiredHome | 78:faf49c381591 | 442 | * screen points corresponding |
WiredHome | 78:faf49c381591 | 443 | * to the reference display points. |
WiredHome | 78:faf49c381591 | 444 | * matrixPtr (output) - Pointer to the calibration |
WiredHome | 78:faf49c381591 | 445 | * matrix computed for the set |
WiredHome | 78:faf49c381591 | 446 | * of points being provided. |
WiredHome | 78:faf49c381591 | 447 | * |
WiredHome | 78:faf49c381591 | 448 | * |
WiredHome | 78:faf49c381591 | 449 | * From the article text, recall that the matrix coefficients are |
WiredHome | 78:faf49c381591 | 450 | * resolved to be the following: |
WiredHome | 78:faf49c381591 | 451 | * |
WiredHome | 78:faf49c381591 | 452 | * |
WiredHome | 78:faf49c381591 | 453 | * Divider = (Xs0 - Xs2)*(Ys1 - Ys2) - (Xs1 - Xs2)*(Ys0 - Ys2) |
WiredHome | 78:faf49c381591 | 454 | * |
WiredHome | 78:faf49c381591 | 455 | * |
WiredHome | 78:faf49c381591 | 456 | * |
WiredHome | 78:faf49c381591 | 457 | * (Xd0 - Xd2)*(Ys1 - Ys2) - (Xd1 - Xd2)*(Ys0 - Ys2) |
WiredHome | 78:faf49c381591 | 458 | * A = --------------------------------------------------- |
WiredHome | 78:faf49c381591 | 459 | * Divider |
WiredHome | 78:faf49c381591 | 460 | * |
WiredHome | 78:faf49c381591 | 461 | * |
WiredHome | 78:faf49c381591 | 462 | * (Xs0 - Xs2)*(Xd1 - Xd2) - (Xd0 - Xd2)*(Xs1 - Xs2) |
WiredHome | 78:faf49c381591 | 463 | * B = --------------------------------------------------- |
WiredHome | 78:faf49c381591 | 464 | * Divider |
WiredHome | 78:faf49c381591 | 465 | * |
WiredHome | 78:faf49c381591 | 466 | * |
WiredHome | 78:faf49c381591 | 467 | * Ys0*(Xs2*Xd1 - Xs1*Xd2) + |
WiredHome | 78:faf49c381591 | 468 | * Ys1*(Xs0*Xd2 - Xs2*Xd0) + |
WiredHome | 78:faf49c381591 | 469 | * Ys2*(Xs1*Xd0 - Xs0*Xd1) |
WiredHome | 78:faf49c381591 | 470 | * C = --------------------------------------------------- |
WiredHome | 78:faf49c381591 | 471 | * Divider |
WiredHome | 78:faf49c381591 | 472 | * |
WiredHome | 78:faf49c381591 | 473 | * |
WiredHome | 78:faf49c381591 | 474 | * (Yd0 - Yd2)*(Ys1 - Ys2) - (Yd1 - Yd2)*(Ys0 - Ys2) |
WiredHome | 78:faf49c381591 | 475 | * D = --------------------------------------------------- |
WiredHome | 78:faf49c381591 | 476 | * Divider |
WiredHome | 78:faf49c381591 | 477 | * |
WiredHome | 78:faf49c381591 | 478 | * |
WiredHome | 78:faf49c381591 | 479 | * (Xs0 - Xs2)*(Yd1 - Yd2) - (Yd0 - Yd2)*(Xs1 - Xs2) |
WiredHome | 78:faf49c381591 | 480 | * E = --------------------------------------------------- |
WiredHome | 78:faf49c381591 | 481 | * Divider |
WiredHome | 78:faf49c381591 | 482 | * |
WiredHome | 78:faf49c381591 | 483 | * |
WiredHome | 78:faf49c381591 | 484 | * Ys0*(Xs2*Yd1 - Xs1*Yd2) + |
WiredHome | 78:faf49c381591 | 485 | * Ys1*(Xs0*Yd2 - Xs2*Yd0) + |
WiredHome | 78:faf49c381591 | 486 | * Ys2*(Xs1*Yd0 - Xs0*Yd1) |
WiredHome | 78:faf49c381591 | 487 | * F = --------------------------------------------------- |
WiredHome | 78:faf49c381591 | 488 | * Divider |
WiredHome | 78:faf49c381591 | 489 | * |
WiredHome | 78:faf49c381591 | 490 | * |
WiredHome | 78:faf49c381591 | 491 | * Return: OK - the calibration matrix was correctly |
WiredHome | 78:faf49c381591 | 492 | * calculated and its value is in the |
WiredHome | 78:faf49c381591 | 493 | * output argument. |
WiredHome | 78:faf49c381591 | 494 | * NOT_OK - an error was detected and the |
WiredHome | 78:faf49c381591 | 495 | * function failed to return a valid |
WiredHome | 78:faf49c381591 | 496 | * set of matrix values. |
WiredHome | 78:faf49c381591 | 497 | * The only time this sample code returns |
WiredHome | 78:faf49c381591 | 498 | * NOT_OK is when Divider == 0 |
WiredHome | 78:faf49c381591 | 499 | * |
WiredHome | 78:faf49c381591 | 500 | * |
WiredHome | 78:faf49c381591 | 501 | * |
WiredHome | 78:faf49c381591 | 502 | * NOTE! NOTE! NOTE! |
WiredHome | 78:faf49c381591 | 503 | * |
WiredHome | 78:faf49c381591 | 504 | * setCalibrationMatrix() and getDisplayPoint() will do fine |
WiredHome | 78:faf49c381591 | 505 | * for you as they are, provided that your digitizer |
WiredHome | 78:faf49c381591 | 506 | * resolution does not exceed 10 bits (1024 values). Higher |
WiredHome | 78:faf49c381591 | 507 | * resolutions may cause the integer operations to overflow |
WiredHome | 78:faf49c381591 | 508 | * and return incorrect values. If you wish to use these |
WiredHome | 78:faf49c381591 | 509 | * functions with digitizer resolutions of 12 bits (4096 |
WiredHome | 78:faf49c381591 | 510 | * values) you will either have to a) use 64-bit signed |
WiredHome | 78:faf49c381591 | 511 | * integer variables and math, or b) judiciously modify the |
WiredHome | 78:faf49c381591 | 512 | * operations to scale results by a factor of 2 or even 4. |
WiredHome | 78:faf49c381591 | 513 | * |
WiredHome | 78:faf49c381591 | 514 | */ |
WiredHome | 81:01da2e34283d | 515 | RetCode_t RA8875::TouchPanelComputeCalibration(point_t * displayPtr, point_t * screenPtr, tpMatrix_t * matrixPtr) |
WiredHome | 78:faf49c381591 | 516 | { |
WiredHome | 78:faf49c381591 | 517 | RetCode_t retValue = noerror; |
WiredHome | 78:faf49c381591 | 518 | |
WiredHome | 78:faf49c381591 | 519 | tpMatrix.Divider = ((screenPtr[0].x - screenPtr[2].x) * (screenPtr[1].y - screenPtr[2].y)) - |
WiredHome | 78:faf49c381591 | 520 | ((screenPtr[1].x - screenPtr[2].x) * (screenPtr[0].y - screenPtr[2].y)) ; |
WiredHome | 78:faf49c381591 | 521 | |
WiredHome | 78:faf49c381591 | 522 | if( tpMatrix.Divider == 0 ) { |
WiredHome | 78:faf49c381591 | 523 | retValue = bad_parameter; |
WiredHome | 78:faf49c381591 | 524 | } else { |
WiredHome | 78:faf49c381591 | 525 | tpMatrix.An = ((displayPtr[0].x - displayPtr[2].x) * (screenPtr[1].y - screenPtr[2].y)) - |
WiredHome | 78:faf49c381591 | 526 | ((displayPtr[1].x - displayPtr[2].x) * (screenPtr[0].y - screenPtr[2].y)) ; |
WiredHome | 78:faf49c381591 | 527 | |
WiredHome | 78:faf49c381591 | 528 | tpMatrix.Bn = ((screenPtr[0].x - screenPtr[2].x) * (displayPtr[1].x - displayPtr[2].x)) - |
WiredHome | 78:faf49c381591 | 529 | ((displayPtr[0].x - displayPtr[2].x) * (screenPtr[1].x - screenPtr[2].x)) ; |
WiredHome | 78:faf49c381591 | 530 | |
WiredHome | 78:faf49c381591 | 531 | tpMatrix.Cn = (screenPtr[2].x * displayPtr[1].x - screenPtr[1].x * displayPtr[2].x) * screenPtr[0].y + |
WiredHome | 78:faf49c381591 | 532 | (screenPtr[0].x * displayPtr[2].x - screenPtr[2].x * displayPtr[0].x) * screenPtr[1].y + |
WiredHome | 78:faf49c381591 | 533 | (screenPtr[1].x * displayPtr[0].x - screenPtr[0].x * displayPtr[1].x) * screenPtr[2].y ; |
WiredHome | 78:faf49c381591 | 534 | |
WiredHome | 78:faf49c381591 | 535 | tpMatrix.Dn = ((displayPtr[0].y - displayPtr[2].y) * (screenPtr[1].y - screenPtr[2].y)) - |
WiredHome | 78:faf49c381591 | 536 | ((displayPtr[1].y - displayPtr[2].y) * (screenPtr[0].y - screenPtr[2].y)) ; |
WiredHome | 78:faf49c381591 | 537 | |
WiredHome | 78:faf49c381591 | 538 | tpMatrix.En = ((screenPtr[0].x - screenPtr[2].x) * (displayPtr[1].y - displayPtr[2].y)) - |
WiredHome | 78:faf49c381591 | 539 | ((displayPtr[0].y - displayPtr[2].y) * (screenPtr[1].x - screenPtr[2].x)) ; |
WiredHome | 78:faf49c381591 | 540 | |
WiredHome | 78:faf49c381591 | 541 | tpMatrix.Fn = (screenPtr[2].x * displayPtr[1].y - screenPtr[1].x * displayPtr[2].y) * screenPtr[0].y + |
WiredHome | 78:faf49c381591 | 542 | (screenPtr[0].x * displayPtr[2].y - screenPtr[2].x * displayPtr[0].y) * screenPtr[1].y + |
WiredHome | 78:faf49c381591 | 543 | (screenPtr[1].x * displayPtr[0].y - screenPtr[0].x * displayPtr[1].y) * screenPtr[2].y ; |
WiredHome | 83:7bad0068cca0 | 544 | touchState = no_touch; |
WiredHome | 78:faf49c381591 | 545 | if (matrixPtr) |
WiredHome | 78:faf49c381591 | 546 | memcpy(matrixPtr, &tpMatrix, sizeof(tpMatrix_t)); |
WiredHome | 78:faf49c381591 | 547 | } |
WiredHome | 78:faf49c381591 | 548 | return( retValue ) ; |
WiredHome | 78:faf49c381591 | 549 | } |
WiredHome | 78:faf49c381591 | 550 | |
WiredHome | 78:faf49c381591 | 551 | // #### end of touch panel code additions |