StateChart defining behavior for FlippityFlappity project

Dependencies:   MMA8451Q Multi_WS2811 TSI mbed

Committer:
ryanfeng
Date:
Mon Apr 06 20:27:47 2015 +0000
Revision:
0:e72b30045834
Original StateChart for FlippityFlappity.  Find presentation statechart in FishStateChartDemo

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ryanfeng 0:e72b30045834 1 /*
ryanfeng 0:e72b30045834 2 Copyright (c) 2011 Anthony Buckton (abuckton [at] blackink [dot} net {dot} au)
ryanfeng 0:e72b30045834 3
ryanfeng 0:e72b30045834 4 Permission is hereby granted, free of charge, to any person obtaining a copy
ryanfeng 0:e72b30045834 5 of this software and associated documentation files (the "Software"), to deal
ryanfeng 0:e72b30045834 6 in the Software without restriction, including without limitation the rights
ryanfeng 0:e72b30045834 7 to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
ryanfeng 0:e72b30045834 8 copies of the Software, and to permit persons to whom the Software is
ryanfeng 0:e72b30045834 9 furnished to do so, subject to the following conditions:
ryanfeng 0:e72b30045834 10
ryanfeng 0:e72b30045834 11 The above copyright notice and this permission notice shall be included in
ryanfeng 0:e72b30045834 12 all copies or substantial portions of the Software.
ryanfeng 0:e72b30045834 13
ryanfeng 0:e72b30045834 14 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
ryanfeng 0:e72b30045834 15 IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
ryanfeng 0:e72b30045834 16 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
ryanfeng 0:e72b30045834 17 AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
ryanfeng 0:e72b30045834 18 LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
ryanfeng 0:e72b30045834 19 OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
ryanfeng 0:e72b30045834 20 THE SOFTWARE.
ryanfeng 0:e72b30045834 21 */
ryanfeng 0:e72b30045834 22
ryanfeng 0:e72b30045834 23 #include <mbed.h>
ryanfeng 0:e72b30045834 24 #include <sstream>
ryanfeng 0:e72b30045834 25 #include <string>
ryanfeng 0:e72b30045834 26 #include <list>
ryanfeng 0:e72b30045834 27
ryanfeng 0:e72b30045834 28 #include <mpr121.h>
ryanfeng 0:e72b30045834 29
ryanfeng 0:e72b30045834 30 Mpr121::Mpr121(I2C *i2c, Address i2cAddress)
ryanfeng 0:e72b30045834 31 {
ryanfeng 0:e72b30045834 32 this->i2c = i2c;
ryanfeng 0:e72b30045834 33
ryanfeng 0:e72b30045834 34 address = i2cAddress;
ryanfeng 0:e72b30045834 35
ryanfeng 0:e72b30045834 36 // Configure the MPR121 settings to default
ryanfeng 0:e72b30045834 37 this->configureSettings();
ryanfeng 0:e72b30045834 38 }
ryanfeng 0:e72b30045834 39
ryanfeng 0:e72b30045834 40
ryanfeng 0:e72b30045834 41 void Mpr121::configureSettings()
ryanfeng 0:e72b30045834 42 {
ryanfeng 0:e72b30045834 43 // Put the MPR into setup mode
ryanfeng 0:e72b30045834 44 this->write(ELE_CFG,0x00);
ryanfeng 0:e72b30045834 45
ryanfeng 0:e72b30045834 46 // Electrode filters for when data is > baseline
ryanfeng 0:e72b30045834 47 unsigned char gtBaseline[] = {
ryanfeng 0:e72b30045834 48 0x01, //MHD_R
ryanfeng 0:e72b30045834 49 0x01, //NHD_R
ryanfeng 0:e72b30045834 50 0x00, //NCL_R
ryanfeng 0:e72b30045834 51 0x00 //FDL_R
ryanfeng 0:e72b30045834 52 };
ryanfeng 0:e72b30045834 53
ryanfeng 0:e72b30045834 54 writeMany(MHD_R,gtBaseline,4);
ryanfeng 0:e72b30045834 55
ryanfeng 0:e72b30045834 56 // Electrode filters for when data is < baseline
ryanfeng 0:e72b30045834 57 unsigned char ltBaseline[] = {
ryanfeng 0:e72b30045834 58 0x01, //MHD_F
ryanfeng 0:e72b30045834 59 0x01, //NHD_F
ryanfeng 0:e72b30045834 60 0xFF, //NCL_F
ryanfeng 0:e72b30045834 61 0x02 //FDL_F
ryanfeng 0:e72b30045834 62 };
ryanfeng 0:e72b30045834 63
ryanfeng 0:e72b30045834 64 writeMany(MHD_F,ltBaseline,4);
ryanfeng 0:e72b30045834 65
ryanfeng 0:e72b30045834 66 // Electrode touch and release thresholds
ryanfeng 0:e72b30045834 67 unsigned char electrodeThresholds[] = {
ryanfeng 0:e72b30045834 68 E_THR_T, // Touch Threshhold
ryanfeng 0:e72b30045834 69 E_THR_R // Release Threshold
ryanfeng 0:e72b30045834 70 };
ryanfeng 0:e72b30045834 71
ryanfeng 0:e72b30045834 72 for(int i=0; i<12; i++){
ryanfeng 0:e72b30045834 73 int result = writeMany((ELE0_T+(i*2)),electrodeThresholds,2);
ryanfeng 0:e72b30045834 74 }
ryanfeng 0:e72b30045834 75
ryanfeng 0:e72b30045834 76 // Proximity Settings
ryanfeng 0:e72b30045834 77 unsigned char proximitySettings[] = {
ryanfeng 0:e72b30045834 78 0xff, //MHD_Prox_R
ryanfeng 0:e72b30045834 79 0xff, //NHD_Prox_R
ryanfeng 0:e72b30045834 80 0x00, //NCL_Prox_R
ryanfeng 0:e72b30045834 81 0x00, //FDL_Prox_R
ryanfeng 0:e72b30045834 82 0x01, //MHD_Prox_F
ryanfeng 0:e72b30045834 83 0x01, //NHD_Prox_F
ryanfeng 0:e72b30045834 84 0xFF, //NCL_Prox_F
ryanfeng 0:e72b30045834 85 0xff, //FDL_Prox_F
ryanfeng 0:e72b30045834 86 0x00, //NHD_Prox_T
ryanfeng 0:e72b30045834 87 0x00, //NCL_Prox_T
ryanfeng 0:e72b30045834 88 0x00 //NFD_Prox_T
ryanfeng 0:e72b30045834 89 };
ryanfeng 0:e72b30045834 90 writeMany(MHDPROXR,proximitySettings,11);
ryanfeng 0:e72b30045834 91
ryanfeng 0:e72b30045834 92 unsigned char proxThresh[] = {
ryanfeng 0:e72b30045834 93 PROX_THR_T, // Touch Threshold
ryanfeng 0:e72b30045834 94 PROX_THR_R // Release Threshold
ryanfeng 0:e72b30045834 95 };
ryanfeng 0:e72b30045834 96 writeMany(EPROXTTH,proxThresh,2);
ryanfeng 0:e72b30045834 97
ryanfeng 0:e72b30045834 98 this->write(FIL_CFG,0x04);
ryanfeng 0:e72b30045834 99
ryanfeng 0:e72b30045834 100 // Set the electrode config to transition to active mode
ryanfeng 0:e72b30045834 101 this->write(ELE_CFG,0x0c);
ryanfeng 0:e72b30045834 102 }
ryanfeng 0:e72b30045834 103
ryanfeng 0:e72b30045834 104 void Mpr121::setElectrodeThreshold(int electrode, unsigned char touch, unsigned char release){
ryanfeng 0:e72b30045834 105
ryanfeng 0:e72b30045834 106 if(electrode > 11) return;
ryanfeng 0:e72b30045834 107
ryanfeng 0:e72b30045834 108 // Get the current mode
ryanfeng 0:e72b30045834 109 unsigned char mode = this->read(ELE_CFG);
ryanfeng 0:e72b30045834 110
ryanfeng 0:e72b30045834 111 // Put the MPR into setup mode
ryanfeng 0:e72b30045834 112 this->write(ELE_CFG,0x00);
ryanfeng 0:e72b30045834 113
ryanfeng 0:e72b30045834 114 // Write the new threshold
ryanfeng 0:e72b30045834 115 this->write((ELE0_T+(electrode*2)), touch);
ryanfeng 0:e72b30045834 116 this->write((ELE0_T+(electrode*2)+1), release);
ryanfeng 0:e72b30045834 117
ryanfeng 0:e72b30045834 118 //Restore the operating mode
ryanfeng 0:e72b30045834 119 this->write(ELE_CFG, mode);
ryanfeng 0:e72b30045834 120 }
ryanfeng 0:e72b30045834 121
ryanfeng 0:e72b30045834 122
ryanfeng 0:e72b30045834 123 unsigned char Mpr121::read(int key){
ryanfeng 0:e72b30045834 124
ryanfeng 0:e72b30045834 125 unsigned char data[2];
ryanfeng 0:e72b30045834 126
ryanfeng 0:e72b30045834 127 //Start the command
ryanfeng 0:e72b30045834 128 i2c->start();
ryanfeng 0:e72b30045834 129
ryanfeng 0:e72b30045834 130 // Address the target (Write mode)
ryanfeng 0:e72b30045834 131 int ack1= i2c->write(address);
ryanfeng 0:e72b30045834 132
ryanfeng 0:e72b30045834 133 // Set the register key to read
ryanfeng 0:e72b30045834 134 int ack2 = i2c->write(key);
ryanfeng 0:e72b30045834 135
ryanfeng 0:e72b30045834 136 // Re-start for read of data
ryanfeng 0:e72b30045834 137 i2c->start();
ryanfeng 0:e72b30045834 138
ryanfeng 0:e72b30045834 139 // Re-send the target address in read mode
ryanfeng 0:e72b30045834 140 int ack3 = i2c->write(address+1);
ryanfeng 0:e72b30045834 141
ryanfeng 0:e72b30045834 142 // Read in the result
ryanfeng 0:e72b30045834 143 data[0] = i2c->read(0);
ryanfeng 0:e72b30045834 144
ryanfeng 0:e72b30045834 145 // Reset the bus
ryanfeng 0:e72b30045834 146 i2c->stop();
ryanfeng 0:e72b30045834 147
ryanfeng 0:e72b30045834 148 return data[0];
ryanfeng 0:e72b30045834 149 }
ryanfeng 0:e72b30045834 150
ryanfeng 0:e72b30045834 151
ryanfeng 0:e72b30045834 152 int Mpr121::write(int key, unsigned char value){
ryanfeng 0:e72b30045834 153
ryanfeng 0:e72b30045834 154 //Start the command
ryanfeng 0:e72b30045834 155 i2c->start();
ryanfeng 0:e72b30045834 156
ryanfeng 0:e72b30045834 157 // Address the target (Write mode)
ryanfeng 0:e72b30045834 158 int ack1= i2c->write(address);
ryanfeng 0:e72b30045834 159
ryanfeng 0:e72b30045834 160 // Set the register key to write
ryanfeng 0:e72b30045834 161 int ack2 = i2c->write(key);
ryanfeng 0:e72b30045834 162
ryanfeng 0:e72b30045834 163 // Read in the result
ryanfeng 0:e72b30045834 164 int ack3 = i2c->write(value);
ryanfeng 0:e72b30045834 165
ryanfeng 0:e72b30045834 166 // Reset the bus
ryanfeng 0:e72b30045834 167 i2c->stop();
ryanfeng 0:e72b30045834 168
ryanfeng 0:e72b30045834 169 return (ack1+ack2+ack3)-3;
ryanfeng 0:e72b30045834 170 }
ryanfeng 0:e72b30045834 171
ryanfeng 0:e72b30045834 172
ryanfeng 0:e72b30045834 173 int Mpr121::writeMany(int start, unsigned char* dataSet, int length){
ryanfeng 0:e72b30045834 174 //Start the command
ryanfeng 0:e72b30045834 175 i2c->start();
ryanfeng 0:e72b30045834 176
ryanfeng 0:e72b30045834 177 // Address the target (Write mode)
ryanfeng 0:e72b30045834 178 int ack= i2c->write(address);
ryanfeng 0:e72b30045834 179 if(ack!=1){
ryanfeng 0:e72b30045834 180 return -1;
ryanfeng 0:e72b30045834 181 }
ryanfeng 0:e72b30045834 182
ryanfeng 0:e72b30045834 183 // Set the register key to write
ryanfeng 0:e72b30045834 184 ack = i2c->write(start);
ryanfeng 0:e72b30045834 185 if(ack!=1){
ryanfeng 0:e72b30045834 186 return -1;
ryanfeng 0:e72b30045834 187 }
ryanfeng 0:e72b30045834 188
ryanfeng 0:e72b30045834 189 // Write the date set
ryanfeng 0:e72b30045834 190 int count = 0;
ryanfeng 0:e72b30045834 191 while(ack==1 && (count < length)){
ryanfeng 0:e72b30045834 192 ack = i2c->write(dataSet[count]);
ryanfeng 0:e72b30045834 193 count++;
ryanfeng 0:e72b30045834 194 }
ryanfeng 0:e72b30045834 195 // Stop the cmd
ryanfeng 0:e72b30045834 196 i2c->stop();
ryanfeng 0:e72b30045834 197
ryanfeng 0:e72b30045834 198 return count;
ryanfeng 0:e72b30045834 199 }
ryanfeng 0:e72b30045834 200
ryanfeng 0:e72b30045834 201
ryanfeng 0:e72b30045834 202 bool Mpr121::getProximityMode(){
ryanfeng 0:e72b30045834 203 if(this->read(ELE_CFG) > 0x0c)
ryanfeng 0:e72b30045834 204 return true;
ryanfeng 0:e72b30045834 205 else
ryanfeng 0:e72b30045834 206 return false;
ryanfeng 0:e72b30045834 207 }
ryanfeng 0:e72b30045834 208
ryanfeng 0:e72b30045834 209 void Mpr121::setProximityMode(bool mode){
ryanfeng 0:e72b30045834 210 this->write(ELE_CFG,0x00);
ryanfeng 0:e72b30045834 211 if(mode){
ryanfeng 0:e72b30045834 212 this->write(ELE_CFG,0x30); //Sense proximity from ALL pads
ryanfeng 0:e72b30045834 213 } else {
ryanfeng 0:e72b30045834 214 this->write(ELE_CFG,0x0c); //Sense touch, all 12 pads active.
ryanfeng 0:e72b30045834 215 }
ryanfeng 0:e72b30045834 216 }
ryanfeng 0:e72b30045834 217
ryanfeng 0:e72b30045834 218
ryanfeng 0:e72b30045834 219 int Mpr121::readTouchData(){
ryanfeng 0:e72b30045834 220 return this->read(0x00);
ryanfeng 0:e72b30045834 221 }