Wojciech Rynczuk / Mbed 2 deprecated DP_Demo

Dni Przedsiebierczosci Demo

Dependencies:   mbed

TSI/TSISensor.cpp@0:eb5dfc6d9eae, 2017-04-21 (annotated)

Committer:
ketjow
Date:
Fri Apr 21 08:25:54 2017 +0000
Revision:
0:eb5dfc6d9eae
Initial

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ketjow 0:eb5dfc6d9eae 1 /* Freescale Semiconductor Inc.
ketjow 0:eb5dfc6d9eae 2 * (c) Copyright 2004-2005 Freescale Semiconductor, Inc.
ketjow 0:eb5dfc6d9eae 3 * (c) Copyright 2001-2004 Motorola, Inc.
ketjow 0:eb5dfc6d9eae 4 *
ketjow 0:eb5dfc6d9eae 5 * mbed Microcontroller Library
ketjow 0:eb5dfc6d9eae 6 * (c) Copyright 2009-2012 ARM Limited.
ketjow 0:eb5dfc6d9eae 7 *
ketjow 0:eb5dfc6d9eae 8 * Permission is hereby granted, free of charge, to any person obtaining a copy of this software
ketjow 0:eb5dfc6d9eae 9 * and associated documentation files (the "Software"), to deal in the Software without
ketjow 0:eb5dfc6d9eae 10 * restriction, including without limitation the rights to use, copy, modify, merge, publish,
ketjow 0:eb5dfc6d9eae 11 * distribute, sublicense, and/or sell copies of the Software, and to permit persons to whom the
ketjow 0:eb5dfc6d9eae 12 * Software is furnished to do so, subject to the following conditions:
ketjow 0:eb5dfc6d9eae 13 *
ketjow 0:eb5dfc6d9eae 14 * The above copyright notice and this permission notice shall be included in all copies or
ketjow 0:eb5dfc6d9eae 15 * substantial portions of the Software.
ketjow 0:eb5dfc6d9eae 16 *
ketjow 0:eb5dfc6d9eae 17 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING
ketjow 0:eb5dfc6d9eae 18 * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
ketjow 0:eb5dfc6d9eae 19 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM,
ketjow 0:eb5dfc6d9eae 20 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
ketjow 0:eb5dfc6d9eae 21 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
ketjow 0:eb5dfc6d9eae 22 */
ketjow 0:eb5dfc6d9eae 23
ketjow 0:eb5dfc6d9eae 24 #include "mbed.h"
ketjow 0:eb5dfc6d9eae 25 #include "TSISensor.h"
ketjow 0:eb5dfc6d9eae 26
ketjow 0:eb5dfc6d9eae 27 #define NO_TOUCH 0
ketjow 0:eb5dfc6d9eae 28 #define SLIDER_LENGTH 40 //LENGTH in mm
ketjow 0:eb5dfc6d9eae 29 #define TOTAL_ELECTRODE 3
ketjow 0:eb5dfc6d9eae 30
ketjow 0:eb5dfc6d9eae 31 #define TSI0a 0
ketjow 0:eb5dfc6d9eae 32 #define TSI1 1
ketjow 0:eb5dfc6d9eae 33 #define TSI2 2
ketjow 0:eb5dfc6d9eae 34 #define TSI3 3
ketjow 0:eb5dfc6d9eae 35 #define TSI4 4
ketjow 0:eb5dfc6d9eae 36 #define TSI5 5
ketjow 0:eb5dfc6d9eae 37 #define TSI6 6
ketjow 0:eb5dfc6d9eae 38 #define TSI7 7
ketjow 0:eb5dfc6d9eae 39 #define TSI8 8
ketjow 0:eb5dfc6d9eae 40 #define TSI9 9
ketjow 0:eb5dfc6d9eae 41 #define TSI10 10
ketjow 0:eb5dfc6d9eae 42 #define TSI11 11
ketjow 0:eb5dfc6d9eae 43 #define TSI12 12
ketjow 0:eb5dfc6d9eae 44 #define TSI13 13
ketjow 0:eb5dfc6d9eae 45 #define TSI14 14
ketjow 0:eb5dfc6d9eae 46 #define TSI15 15
ketjow 0:eb5dfc6d9eae 47
ketjow 0:eb5dfc6d9eae 48 /*Chose the correct TSI channel for the electrode number*/
ketjow 0:eb5dfc6d9eae 49 #define ELECTRODE0 TSI9
ketjow 0:eb5dfc6d9eae 50 #define ELECTRODE1 TSI10
ketjow 0:eb5dfc6d9eae 51 #define ELECTRODE2 TSI0a
ketjow 0:eb5dfc6d9eae 52 #define ELECTRODE3 TSI1
ketjow 0:eb5dfc6d9eae 53 #define ELECTRODE4 TSI2
ketjow 0:eb5dfc6d9eae 54 #define ELECTRODE5 TSI3
ketjow 0:eb5dfc6d9eae 55 #define ELECTRODE6 TSI4
ketjow 0:eb5dfc6d9eae 56 #define ELECTRODE7 TSI5
ketjow 0:eb5dfc6d9eae 57 #define ELECTRODE8 TSI6
ketjow 0:eb5dfc6d9eae 58 #define ELECTRODE9 TSI7
ketjow 0:eb5dfc6d9eae 59 #define ELECTRODE10 TSI8
ketjow 0:eb5dfc6d9eae 60 #define ELECTRODE11 TSI11
ketjow 0:eb5dfc6d9eae 61 #define ELECTRODE12 TSI12
ketjow 0:eb5dfc6d9eae 62 #define ELECTRODE13 TSI13
ketjow 0:eb5dfc6d9eae 63 #define ELECTRODE14 TSI14
ketjow 0:eb5dfc6d9eae 64 #define ELECTRODE15 TSI15
ketjow 0:eb5dfc6d9eae 65
ketjow 0:eb5dfc6d9eae 66 #define THRESHOLD0 100
ketjow 0:eb5dfc6d9eae 67 #define THRESHOLD1 100
ketjow 0:eb5dfc6d9eae 68 #define THRESHOLD2 100
ketjow 0:eb5dfc6d9eae 69 #define THRESHOLD3 100
ketjow 0:eb5dfc6d9eae 70 #define THRESHOLD4 100
ketjow 0:eb5dfc6d9eae 71 #define THRESHOLD5 100
ketjow 0:eb5dfc6d9eae 72 #define THRESHOLD6 100
ketjow 0:eb5dfc6d9eae 73 #define THRESHOLD7 100
ketjow 0:eb5dfc6d9eae 74 #define THRESHOLD8 100
ketjow 0:eb5dfc6d9eae 75 #define THRESHOLD9 100
ketjow 0:eb5dfc6d9eae 76 #define THRESHOLD10 100
ketjow 0:eb5dfc6d9eae 77 #define THRESHOLD11 100
ketjow 0:eb5dfc6d9eae 78 #define THRESHOLD12 100
ketjow 0:eb5dfc6d9eae 79 #define THRESHOLD13 100
ketjow 0:eb5dfc6d9eae 80 #define THRESHOLD14 100
ketjow 0:eb5dfc6d9eae 81 #define THRESHOLD15 100
ketjow 0:eb5dfc6d9eae 82
ketjow 0:eb5dfc6d9eae 83 static uint8_t total_electrode = TOTAL_ELECTRODE;
ketjow 0:eb5dfc6d9eae 84 static uint8_t elec_array[16]={ELECTRODE0,ELECTRODE1,ELECTRODE2,ELECTRODE3,ELECTRODE4,ELECTRODE5,
ketjow 0:eb5dfc6d9eae 85 ELECTRODE6,ELECTRODE7,ELECTRODE8,ELECTRODE9,ELECTRODE10,ELECTRODE11,
ketjow 0:eb5dfc6d9eae 86 ELECTRODE12,ELECTRODE13,ELECTRODE14,ELECTRODE15};
ketjow 0:eb5dfc6d9eae 87 static uint16_t gu16TSICount[16];
ketjow 0:eb5dfc6d9eae 88 static uint16_t gu16Baseline[16];
ketjow 0:eb5dfc6d9eae 89 static uint16_t gu16Threshold[16]={THRESHOLD0,THRESHOLD1,THRESHOLD2,THRESHOLD3,THRESHOLD4,THRESHOLD5,
ketjow 0:eb5dfc6d9eae 90 THRESHOLD6,THRESHOLD7,THRESHOLD8,THRESHOLD9,THRESHOLD10,THRESHOLD11,
ketjow 0:eb5dfc6d9eae 91 THRESHOLD12,THRESHOLD13,THRESHOLD14,THRESHOLD15};
ketjow 0:eb5dfc6d9eae 92 static uint16_t gu16Delta[16];
ketjow 0:eb5dfc6d9eae 93 static uint8_t ongoing_elec;
ketjow 0:eb5dfc6d9eae 94 static uint8_t end_flag = 1;
ketjow 0:eb5dfc6d9eae 95
ketjow 0:eb5dfc6d9eae 96 static uint8_t SliderPercentegePosition[2] = {NO_TOUCH,NO_TOUCH};
ketjow 0:eb5dfc6d9eae 97 static uint8_t SliderDistancePosition[2] = {NO_TOUCH,NO_TOUCH};
ketjow 0:eb5dfc6d9eae 98 static uint32_t AbsolutePercentegePosition = NO_TOUCH;
ketjow 0:eb5dfc6d9eae 99 static uint32_t AbsoluteDistancePosition = NO_TOUCH;
ketjow 0:eb5dfc6d9eae 100
ketjow 0:eb5dfc6d9eae 101 static void tsi_irq();
ketjow 0:eb5dfc6d9eae 102
ketjow 0:eb5dfc6d9eae 103 TSISensor::TSISensor() {
ketjow 0:eb5dfc6d9eae 104 SIM->SCGC5 |= SIM_SCGC5_PORTB_MASK;
ketjow 0:eb5dfc6d9eae 105 SIM->SCGC5 |= SIM_SCGC5_TSI_MASK;
ketjow 0:eb5dfc6d9eae 106
ketjow 0:eb5dfc6d9eae 107 TSI0->GENCS |= (TSI_GENCS_ESOR_MASK
ketjow 0:eb5dfc6d9eae 108 | TSI_GENCS_MODE(0)
ketjow 0:eb5dfc6d9eae 109 | TSI_GENCS_REFCHRG(4)
ketjow 0:eb5dfc6d9eae 110 | TSI_GENCS_DVOLT(0)
ketjow 0:eb5dfc6d9eae 111 | TSI_GENCS_EXTCHRG(7)
ketjow 0:eb5dfc6d9eae 112 | TSI_GENCS_PS(4)
ketjow 0:eb5dfc6d9eae 113 | TSI_GENCS_NSCN(11)
ketjow 0:eb5dfc6d9eae 114 | TSI_GENCS_TSIIEN_MASK
ketjow 0:eb5dfc6d9eae 115 | TSI_GENCS_STPE_MASK
ketjow 0:eb5dfc6d9eae 116 );
ketjow 0:eb5dfc6d9eae 117
ketjow 0:eb5dfc6d9eae 118 TSI0->GENCS |= TSI_GENCS_TSIEN_MASK;
ketjow 0:eb5dfc6d9eae 119
ketjow 0:eb5dfc6d9eae 120 NVIC_SetVector(TSI0_IRQn, (uint32_t)&tsi_irq);
ketjow 0:eb5dfc6d9eae 121 NVIC_EnableIRQ(TSI0_IRQn);
ketjow 0:eb5dfc6d9eae 122
ketjow 0:eb5dfc6d9eae 123 selfCalibration();
ketjow 0:eb5dfc6d9eae 124 }
ketjow 0:eb5dfc6d9eae 125
ketjow 0:eb5dfc6d9eae 126 void TSISensor::TSISensor_reset(void) {
ketjow 0:eb5dfc6d9eae 127 SIM->SCGC5 |= SIM_SCGC5_PORTB_MASK;
ketjow 0:eb5dfc6d9eae 128 SIM->SCGC5 |= SIM_SCGC5_TSI_MASK;
ketjow 0:eb5dfc6d9eae 129
ketjow 0:eb5dfc6d9eae 130 TSI0->GENCS |= (TSI_GENCS_ESOR_MASK
ketjow 0:eb5dfc6d9eae 131 | TSI_GENCS_MODE(0)
ketjow 0:eb5dfc6d9eae 132 | TSI_GENCS_REFCHRG(4)
ketjow 0:eb5dfc6d9eae 133 | TSI_GENCS_DVOLT(0)
ketjow 0:eb5dfc6d9eae 134 | TSI_GENCS_EXTCHRG(7)
ketjow 0:eb5dfc6d9eae 135 | TSI_GENCS_PS(4)
ketjow 0:eb5dfc6d9eae 136 | TSI_GENCS_NSCN(11)
ketjow 0:eb5dfc6d9eae 137 | TSI_GENCS_TSIIEN_MASK
ketjow 0:eb5dfc6d9eae 138 | TSI_GENCS_STPE_MASK
ketjow 0:eb5dfc6d9eae 139 );
ketjow 0:eb5dfc6d9eae 140
ketjow 0:eb5dfc6d9eae 141 TSI0->GENCS |= TSI_GENCS_TSIEN_MASK;
ketjow 0:eb5dfc6d9eae 142
ketjow 0:eb5dfc6d9eae 143 //NVIC_SetVector(TSI0_IRQn, (uint32_t)&tsi_irq);
ketjow 0:eb5dfc6d9eae 144 //NVIC_EnableIRQ(TSI0_IRQn);
ketjow 0:eb5dfc6d9eae 145
ketjow 0:eb5dfc6d9eae 146 selfCalibration();
ketjow 0:eb5dfc6d9eae 147 }
ketjow 0:eb5dfc6d9eae 148
ketjow 0:eb5dfc6d9eae 149 void TSISensor::selfCalibration(void)
ketjow 0:eb5dfc6d9eae 150 {
ketjow 0:eb5dfc6d9eae 151 unsigned char cnt;
ketjow 0:eb5dfc6d9eae 152 unsigned char trigger_backup;
ketjow 0:eb5dfc6d9eae 153
ketjow 0:eb5dfc6d9eae 154 TSI0->GENCS |= TSI_GENCS_EOSF_MASK; // Clear End of Scan Flag
ketjow 0:eb5dfc6d9eae 155 TSI0->GENCS &= ~TSI_GENCS_TSIEN_MASK; // Disable TSI module
ketjow 0:eb5dfc6d9eae 156
ketjow 0:eb5dfc6d9eae 157 if(TSI0->GENCS & TSI_GENCS_STM_MASK) // Back-up TSI Trigger mode from Application
ketjow 0:eb5dfc6d9eae 158 trigger_backup = 1;
ketjow 0:eb5dfc6d9eae 159 else
ketjow 0:eb5dfc6d9eae 160 trigger_backup = 0;
ketjow 0:eb5dfc6d9eae 161
ketjow 0:eb5dfc6d9eae 162 TSI0->GENCS &= ~TSI_GENCS_STM_MASK; // Use SW trigger
ketjow 0:eb5dfc6d9eae 163 TSI0->GENCS &= ~TSI_GENCS_TSIIEN_MASK; // Enable TSI interrupts
ketjow 0:eb5dfc6d9eae 164
ketjow 0:eb5dfc6d9eae 165 TSI0->GENCS |= TSI_GENCS_TSIEN_MASK; // Enable TSI module
ketjow 0:eb5dfc6d9eae 166
ketjow 0:eb5dfc6d9eae 167 for(cnt=0; cnt < total_electrode; cnt++) // Get Counts when Electrode not pressed
ketjow 0:eb5dfc6d9eae 168 {
ketjow 0:eb5dfc6d9eae 169 TSI0->DATA = ((elec_array[cnt] << TSI_DATA_TSICH_SHIFT) );
ketjow 0:eb5dfc6d9eae 170 TSI0->DATA |= TSI_DATA_SWTS_MASK;
ketjow 0:eb5dfc6d9eae 171 while(!(TSI0->GENCS & TSI_GENCS_EOSF_MASK));
ketjow 0:eb5dfc6d9eae 172 TSI0->GENCS |= TSI_GENCS_EOSF_MASK;
ketjow 0:eb5dfc6d9eae 173 gu16Baseline[cnt] = (TSI0->DATA & TSI_DATA_TSICNT_MASK);
ketjow 0:eb5dfc6d9eae 174 }
ketjow 0:eb5dfc6d9eae 175
ketjow 0:eb5dfc6d9eae 176 TSI0->GENCS &= ~TSI_GENCS_TSIEN_MASK; // Disable TSI module
ketjow 0:eb5dfc6d9eae 177 TSI0->GENCS |= TSI_GENCS_TSIIEN_MASK; // Enale TSI interrupt
ketjow 0:eb5dfc6d9eae 178 if(trigger_backup) // Restore trigger mode
ketjow 0:eb5dfc6d9eae 179 TSI0->GENCS |= TSI_GENCS_STM_MASK;
ketjow 0:eb5dfc6d9eae 180 else
ketjow 0:eb5dfc6d9eae 181 TSI0->GENCS &= ~TSI_GENCS_STM_MASK;
ketjow 0:eb5dfc6d9eae 182
ketjow 0:eb5dfc6d9eae 183 TSI0->GENCS |= TSI_GENCS_TSIEN_MASK; // Enable TSI module
ketjow 0:eb5dfc6d9eae 184
ketjow 0:eb5dfc6d9eae 185 TSI0->DATA = ((elec_array[0]<<TSI_DATA_TSICH_SHIFT) );
ketjow 0:eb5dfc6d9eae 186 TSI0->DATA |= TSI_DATA_SWTS_MASK;
ketjow 0:eb5dfc6d9eae 187 }
ketjow 0:eb5dfc6d9eae 188
ketjow 0:eb5dfc6d9eae 189 void TSISensor::sliderRead(void ) {
ketjow 0:eb5dfc6d9eae 190 if(end_flag) {
ketjow 0:eb5dfc6d9eae 191 end_flag = 0;
ketjow 0:eb5dfc6d9eae 192 if((gu16Delta[0] > gu16Threshold[0])||(gu16Delta[1] > gu16Threshold[1])) {
ketjow 0:eb5dfc6d9eae 193 SliderPercentegePosition[0] = (gu16Delta[0]*100)/(gu16Delta[0]+gu16Delta[1]);
ketjow 0:eb5dfc6d9eae 194 SliderPercentegePosition[1] = (gu16Delta[1]*100)/(gu16Delta[0]+gu16Delta[1]);
ketjow 0:eb5dfc6d9eae 195 SliderDistancePosition[0] = (SliderPercentegePosition[0]* SLIDER_LENGTH)/100;
ketjow 0:eb5dfc6d9eae 196 SliderDistancePosition[1] = (SliderPercentegePosition[1]* SLIDER_LENGTH)/100;
ketjow 0:eb5dfc6d9eae 197 AbsolutePercentegePosition = ((100 - SliderPercentegePosition[0]) + SliderPercentegePosition[1])/2;
ketjow 0:eb5dfc6d9eae 198 AbsoluteDistancePosition = ((SLIDER_LENGTH - SliderDistancePosition[0]) + SliderDistancePosition[1])/2;
ketjow 0:eb5dfc6d9eae 199 } else {
ketjow 0:eb5dfc6d9eae 200 SliderPercentegePosition[0] = NO_TOUCH;
ketjow 0:eb5dfc6d9eae 201 SliderPercentegePosition[1] = NO_TOUCH;
ketjow 0:eb5dfc6d9eae 202 SliderDistancePosition[0] = NO_TOUCH;
ketjow 0:eb5dfc6d9eae 203 SliderDistancePosition[1] = NO_TOUCH;
ketjow 0:eb5dfc6d9eae 204 AbsolutePercentegePosition = NO_TOUCH;
ketjow 0:eb5dfc6d9eae 205 AbsoluteDistancePosition = NO_TOUCH;
ketjow 0:eb5dfc6d9eae 206 }
ketjow 0:eb5dfc6d9eae 207 }
ketjow 0:eb5dfc6d9eae 208 }
ketjow 0:eb5dfc6d9eae 209
ketjow 0:eb5dfc6d9eae 210 float TSISensor::readPercentage() {
ketjow 0:eb5dfc6d9eae 211 sliderRead();
ketjow 0:eb5dfc6d9eae 212 return (float)AbsolutePercentegePosition/100.0;
ketjow 0:eb5dfc6d9eae 213 }
ketjow 0:eb5dfc6d9eae 214
ketjow 0:eb5dfc6d9eae 215 uint8_t TSISensor::readDistance() {
ketjow 0:eb5dfc6d9eae 216 sliderRead();
ketjow 0:eb5dfc6d9eae 217 return AbsoluteDistancePosition;
ketjow 0:eb5dfc6d9eae 218 }
ketjow 0:eb5dfc6d9eae 219
ketjow 0:eb5dfc6d9eae 220 uint16_t TSISensor::readValue(uint8_t index)
ketjow 0:eb5dfc6d9eae 221 {
ketjow 0:eb5dfc6d9eae 222 return gu16TSICount[index];
ketjow 0:eb5dfc6d9eae 223 }
ketjow 0:eb5dfc6d9eae 224
ketjow 0:eb5dfc6d9eae 225 static void changeElectrode(void)
ketjow 0:eb5dfc6d9eae 226 {
ketjow 0:eb5dfc6d9eae 227 int16_t u16temp_delta;
ketjow 0:eb5dfc6d9eae 228
ketjow 0:eb5dfc6d9eae 229 gu16TSICount[ongoing_elec] = (TSI0->DATA & TSI_DATA_TSICNT_MASK); // Save Counts for current electrode
ketjow 0:eb5dfc6d9eae 230 u16temp_delta = gu16TSICount[ongoing_elec] - gu16Baseline[ongoing_elec]; // Obtains Counts Delta from callibration reference
ketjow 0:eb5dfc6d9eae 231 if(u16temp_delta < 0)
ketjow 0:eb5dfc6d9eae 232 gu16Delta[ongoing_elec] = 0;
ketjow 0:eb5dfc6d9eae 233 else
ketjow 0:eb5dfc6d9eae 234 gu16Delta[ongoing_elec] = u16temp_delta;
ketjow 0:eb5dfc6d9eae 235
ketjow 0:eb5dfc6d9eae 236 //Change Electrode to Scan
ketjow 0:eb5dfc6d9eae 237 if(total_electrode > 1)
ketjow 0:eb5dfc6d9eae 238 {
ketjow 0:eb5dfc6d9eae 239 if((total_electrode-1) > ongoing_elec)
ketjow 0:eb5dfc6d9eae 240 ongoing_elec++;
ketjow 0:eb5dfc6d9eae 241 else
ketjow 0:eb5dfc6d9eae 242 ongoing_elec = 0;
ketjow 0:eb5dfc6d9eae 243
ketjow 0:eb5dfc6d9eae 244 TSI0->DATA = ((elec_array[ongoing_elec]<<TSI_DATA_TSICH_SHIFT) );
ketjow 0:eb5dfc6d9eae 245 TSI0->DATA |= TSI_DATA_SWTS_MASK;
ketjow 0:eb5dfc6d9eae 246 }
ketjow 0:eb5dfc6d9eae 247 }
ketjow 0:eb5dfc6d9eae 248
ketjow 0:eb5dfc6d9eae 249 void tsi_irq(void)
ketjow 0:eb5dfc6d9eae 250 {
ketjow 0:eb5dfc6d9eae 251 end_flag = 1;
ketjow 0:eb5dfc6d9eae 252 TSI0->GENCS |= TSI_GENCS_EOSF_MASK; // Clear End of Scan Flag
ketjow 0:eb5dfc6d9eae 253 changeElectrode();
ketjow 0:eb5dfc6d9eae 254 }