Marcin Kubicz / Mbed 2 deprecated KL46Z-Lab2_full

KL46Z-lab2

Dependencies:   SLCD- mbed TSI MMA8451Q USBDevice MAG3110

TSI/TSISensor.cpp@0:29277ae50860, 2019-02-21 (annotated)

Committer:
Lokkus
Date:
Thu Feb 21 07:41:00 2019 +0000
Revision:
0:29277ae50860
KL46Z-lab2

Who changed what in which revision?

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