Przemek Dawid / Mbed 2 deprecated KL46Z-Lab2_szkolenie

akcelerometr i czujnik swiatla

Dependencies:   MAG3110 MMA8451Q SLCD- TSI USBDevice mbed

TSI/TSISensor.cpp@0:9f7e045dcaa5, 2014-04-16 (annotated)

Committer:
zochmen
Date:
Wed Apr 16 12:20:13 2014 +0000
Revision:
0:9f7e045dcaa5
akcelerometr; czujnika swiatla;

Who changed what in which revision?

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