xm Nan / Mbed 2 deprecated sensors_KL46Z_xmn

configure sensors on FRDM KL46Z and send data through Serial port. Need host(PC) software to interact with. Sampling rate can vary by proper instruction

Dependencies:   EventFramework mbed

TSISensor.cpp@0:2b49a387e831, 2014-02-15 (annotated)

Committer:
xmnan
Date:
Sat Feb 15 07:52:46 2014 +0000
Revision:
0:2b49a387e831
original version.; Utilize EventFrameWork; sensors: MMA8451Q MAG3110 TSISensor lightSensor + analog input

Who changed what in which revision?

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