Control library for the Sparkfun Entertainment Trackballer breakout board.

Committer:
Nakor
Date:
Sun Feb 20 17:33:59 2011 +0000
Revision:
14:d566efcd787b
Parent:
13:b37eb30297a3
Child:
15:a66aea99500e

        

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Nakor 0:2743c73d648d 1 #include "mbed.h"
Nakor 0:2743c73d648d 2 #include "trackballer.h"
Nakor 0:2743c73d648d 3
Nakor 0:2743c73d648d 4
Nakor 0:2743c73d648d 5
Nakor 0:2743c73d648d 6
Nakor 6:c0ebd0f8f873 7 trackballer::trackballer(PinName button, PinName right, PinName down, PinName left, PinName up, PinName red, PinName green, PinName blue, PinName white, char limits)
Nakor 0:2743c73d648d 8 {
Nakor 0:2743c73d648d 9
Nakor 6:c0ebd0f8f873 10 _limits = limits;
Nakor 6:c0ebd0f8f873 11
Nakor 0:2743c73d648d 12 _buttonPin = new DigitalIn(button);
Nakor 0:2743c73d648d 13 _rightPin = new DigitalIn(right);
Nakor 0:2743c73d648d 14 _downPin = new DigitalIn(down);
Nakor 0:2743c73d648d 15 _leftPin = new DigitalIn(left);
Nakor 0:2743c73d648d 16 _upPin = new DigitalIn(up);
Nakor 0:2743c73d648d 17
Nakor 0:2743c73d648d 18 _redLED = new PwmOut(red);
Nakor 0:2743c73d648d 19 _greenLED = new PwmOut(green);
Nakor 0:2743c73d648d 20 _blueLED = new PwmOut(blue);
Nakor 0:2743c73d648d 21 _whiteLED = new PwmOut(white);
Nakor 0:2743c73d648d 22
Nakor 0:2743c73d648d 23
Nakor 0:2743c73d648d 24
Nakor 0:2743c73d648d 25 _buttonPushCounter = 0; // counter for the number of button presses
Nakor 0:2743c73d648d 26
Nakor 11:35347e6474f9 27 _buttonState = 1; // current state of the button
Nakor 11:35347e6474f9 28 _lastButtonState = 1; // previous state of the button
Nakor 0:2743c73d648d 29
Nakor 0:2743c73d648d 30 _upState = 0;
Nakor 0:2743c73d648d 31 _downState = 0;
Nakor 0:2743c73d648d 32 _leftState = 0;
Nakor 0:2743c73d648d 33 _rightState = 0;
Nakor 0:2743c73d648d 34 _lastUpState = 0;
Nakor 0:2743c73d648d 35 _lastDownState = 0;
Nakor 0:2743c73d648d 36 _lastLeftState = 0;
Nakor 0:2743c73d648d 37 _lastRightState = 0;
Nakor 0:2743c73d648d 38
Nakor 7:229fc175e05e 39 _xPosition = 0.5;
Nakor 7:229fc175e05e 40 _yPosition = 0.5;
Nakor 0:2743c73d648d 41
Nakor 0:2743c73d648d 42
Nakor 0:2743c73d648d 43 _buttonPin->mode(PullUp);
Nakor 0:2743c73d648d 44
Nakor 0:2743c73d648d 45 _redLED->write(0.0);
Nakor 0:2743c73d648d 46 _greenLED->write(0.0);
Nakor 0:2743c73d648d 47 _blueLED->write(0.0);
Nakor 0:2743c73d648d 48 _whiteLED->write(0.0);
Nakor 0:2743c73d648d 49
Nakor 0:2743c73d648d 50 _direction = 0x00;
Nakor 0:2743c73d648d 51
Nakor 0:2743c73d648d 52 _outputTimer.start();
Nakor 0:2743c73d648d 53
Nakor 0:2743c73d648d 54 }
Nakor 0:2743c73d648d 55
Nakor 0:2743c73d648d 56
Nakor 0:2743c73d648d 57
Nakor 0:2743c73d648d 58 /******************/
Nakor 0:2743c73d648d 59 /* Public */
Nakor 0:2743c73d648d 60 /******************/
Nakor 0:2743c73d648d 61
Nakor 0:2743c73d648d 62
Nakor 5:0abcaea1fb07 63 void trackballer::getState(float &xPosition, float &yPosition, char &button)
Nakor 0:2743c73d648d 64 {
Nakor 0:2743c73d648d 65
Nakor 0:2743c73d648d 66 _buttonState = _buttonPin->read();
Nakor 0:2743c73d648d 67
Nakor 14:d566efcd787b 68 //int counter1 = 0;
Nakor 14:d566efcd787b 69
Nakor 0:2743c73d648d 70 // compare the _buttonState to its previous state
Nakor 0:2743c73d648d 71 if (_buttonState != _lastButtonState)
Nakor 0:2743c73d648d 72 {
Nakor 14:d566efcd787b 73
Nakor 0:2743c73d648d 74 // if the state has changed, increment the counter
Nakor 0:2743c73d648d 75 if (_buttonState == 1)
Nakor 0:2743c73d648d 76 {
Nakor 14:d566efcd787b 77 /*
Nakor 14:d566efcd787b 78 while(_buttonPin->read() == _buttonState)
Nakor 14:d566efcd787b 79 {
Nakor 14:d566efcd787b 80 //printf("HELD\n");
Nakor 14:d566efcd787b 81 counter1++;
Nakor 14:d566efcd787b 82 if(counter1 > 20)
Nakor 14:d566efcd787b 83 {
Nakor 14:d566efcd787b 84 printf("HELD\n");
Nakor 14:d566efcd787b 85 return;
Nakor 14:d566efcd787b 86 }
Nakor 14:d566efcd787b 87 }
Nakor 14:d566efcd787b 88 */
Nakor 0:2743c73d648d 89 // if the current state is 1 then the button
Nakor 0:2743c73d648d 90 // went from off to on:
Nakor 0:2743c73d648d 91 _buttonPushCounter++;
Nakor 10:9b35f63411ad 92 button = 0x01;
Nakor 10:9b35f63411ad 93 //printf("Number of button pushes: %i\n", _buttonPushCounter);
Nakor 0:2743c73d648d 94 }
Nakor 0:2743c73d648d 95 }
Nakor 10:9b35f63411ad 96 else
Nakor 10:9b35f63411ad 97 {
Nakor 10:9b35f63411ad 98 button = 0x00;
Nakor 10:9b35f63411ad 99 }
Nakor 0:2743c73d648d 100 _lastButtonState = _buttonState;
Nakor 10:9b35f63411ad 101 //button = !_buttonState;
Nakor 0:2743c73d648d 102
Nakor 0:2743c73d648d 103
Nakor 0:2743c73d648d 104 if (_buttonPushCounter % 2 == 0)
Nakor 0:2743c73d648d 105 {
Nakor 0:2743c73d648d 106 _redLED->write(1);
Nakor 8:2602108edf40 107 //button = 0x01;
Nakor 0:2743c73d648d 108 }
Nakor 0:2743c73d648d 109 else
Nakor 0:2743c73d648d 110 {
Nakor 0:2743c73d648d 111 _redLED->write(0);
Nakor 8:2602108edf40 112 //button = 0x00;
Nakor 0:2743c73d648d 113 }
Nakor 0:2743c73d648d 114
Nakor 0:2743c73d648d 115 _upState = _upPin->read();
Nakor 0:2743c73d648d 116
Nakor 0:2743c73d648d 117 if (_upState != _lastUpState)
Nakor 0:2743c73d648d 118 {
Nakor 0:2743c73d648d 119 if (_upState == 1)
Nakor 0:2743c73d648d 120 {
Nakor 0:2743c73d648d 121 // if the current state is 1 then the button
Nakor 0:2743c73d648d 122 // went from off to on:
Nakor 0:2743c73d648d 123 _yPosition-=TRACK_INC;
Nakor 6:c0ebd0f8f873 124 if(_limits)
Nakor 0:2743c73d648d 125 {
Nakor 6:c0ebd0f8f873 126 if (_yPosition < 0.0)
Nakor 6:c0ebd0f8f873 127 {
Nakor 6:c0ebd0f8f873 128 _yPosition = 0.0;
Nakor 6:c0ebd0f8f873 129 }
Nakor 0:2743c73d648d 130 }
Nakor 0:2743c73d648d 131 }
Nakor 0:2743c73d648d 132 }
Nakor 0:2743c73d648d 133 _lastUpState = _upState;
Nakor 0:2743c73d648d 134
Nakor 0:2743c73d648d 135
Nakor 0:2743c73d648d 136 _downState = _downPin->read();
Nakor 0:2743c73d648d 137
Nakor 0:2743c73d648d 138 // compare the _buttonState to its previous state
Nakor 0:2743c73d648d 139 if (_downState != _lastDownState)
Nakor 0:2743c73d648d 140 {
Nakor 0:2743c73d648d 141 // if the state has changed, increment the counter
Nakor 0:2743c73d648d 142 if (_downState == 1)
Nakor 0:2743c73d648d 143 {
Nakor 0:2743c73d648d 144 // if the current state is 1 then the button
Nakor 0:2743c73d648d 145 // went from off to on:
Nakor 0:2743c73d648d 146 _yPosition+=TRACK_INC;
Nakor 6:c0ebd0f8f873 147 if(_limits)
Nakor 0:2743c73d648d 148 {
Nakor 6:c0ebd0f8f873 149 if (_yPosition > 1.0)
Nakor 6:c0ebd0f8f873 150 {
Nakor 6:c0ebd0f8f873 151 _yPosition = 1.0;
Nakor 6:c0ebd0f8f873 152 }
Nakor 0:2743c73d648d 153 }
Nakor 0:2743c73d648d 154 }
Nakor 0:2743c73d648d 155 }
Nakor 0:2743c73d648d 156 _lastDownState = _downState;
Nakor 0:2743c73d648d 157
Nakor 0:2743c73d648d 158
Nakor 0:2743c73d648d 159 _leftState = _leftPin->read();
Nakor 0:2743c73d648d 160
Nakor 0:2743c73d648d 161 // compare the _buttonState to its previous state
Nakor 0:2743c73d648d 162 if (_leftState != _lastLeftState)
Nakor 0:2743c73d648d 163 {
Nakor 0:2743c73d648d 164 // if the state has changed, increment the counter
Nakor 0:2743c73d648d 165 if (_leftState == 1)
Nakor 0:2743c73d648d 166 {
Nakor 0:2743c73d648d 167 // if the current state is 1 then the button
Nakor 0:2743c73d648d 168 // went from off to on:
Nakor 0:2743c73d648d 169 _xPosition-=TRACK_INC;
Nakor 6:c0ebd0f8f873 170 if(_limits)
Nakor 0:2743c73d648d 171 {
Nakor 6:c0ebd0f8f873 172 if (_xPosition < 0.0)
Nakor 6:c0ebd0f8f873 173 {
Nakor 6:c0ebd0f8f873 174 _xPosition = 0.0;
Nakor 6:c0ebd0f8f873 175 }
Nakor 0:2743c73d648d 176 }
Nakor 0:2743c73d648d 177 }
Nakor 0:2743c73d648d 178 }
Nakor 0:2743c73d648d 179 _lastLeftState = _leftState;
Nakor 0:2743c73d648d 180
Nakor 0:2743c73d648d 181 _rightState = _rightPin->read();
Nakor 0:2743c73d648d 182
Nakor 0:2743c73d648d 183 // compare the _buttonState to its previous state
Nakor 0:2743c73d648d 184 if (_rightState != _lastRightState)
Nakor 0:2743c73d648d 185 {
Nakor 0:2743c73d648d 186 // if the state has changed, increment the counter
Nakor 0:2743c73d648d 187 if (_rightState == 1)
Nakor 0:2743c73d648d 188 {
Nakor 0:2743c73d648d 189 // if the current state is 1 then the button
Nakor 0:2743c73d648d 190 // went from off to on:
Nakor 0:2743c73d648d 191 _xPosition+=TRACK_INC;
Nakor 6:c0ebd0f8f873 192 if(_limits)
Nakor 0:2743c73d648d 193 {
Nakor 6:c0ebd0f8f873 194 if (_xPosition > 1.0)
Nakor 6:c0ebd0f8f873 195 {
Nakor 6:c0ebd0f8f873 196 _xPosition = 1.0;
Nakor 6:c0ebd0f8f873 197 }
Nakor 0:2743c73d648d 198 }
Nakor 0:2743c73d648d 199 }
Nakor 0:2743c73d648d 200 }
Nakor 0:2743c73d648d 201 _lastRightState = _rightState;
Nakor 0:2743c73d648d 202
Nakor 0:2743c73d648d 203 _blueLED->write(_xPosition);
Nakor 0:2743c73d648d 204 _greenLED->write(_yPosition);
Nakor 0:2743c73d648d 205
Nakor 0:2743c73d648d 206 xPosition = _xPosition;
Nakor 0:2743c73d648d 207 yPosition = _yPosition;
Nakor 0:2743c73d648d 208
Nakor 0:2743c73d648d 209
Nakor 6:c0ebd0f8f873 210
Nakor 6:c0ebd0f8f873 211 #if DEBUG_POSITION
Nakor 4:3d1791d6608a 212 int ixPosition = _xPosition * 95;
Nakor 4:3d1791d6608a 213 int iyPosition = _yPosition * 63;
Nakor 4:3d1791d6608a 214
Nakor 6:c0ebd0f8f873 215
Nakor 6:c0ebd0f8f873 216
Nakor 0:2743c73d648d 217 if (_outputTimer.read_ms() > 1000)
Nakor 0:2743c73d648d 218 {
Nakor 4:3d1791d6608a 219 printf("Position: (x%i, y%i)\n", ixPosition, iyPosition);
Nakor 0:2743c73d648d 220
Nakor 0:2743c73d648d 221 _outputTimer.reset();
Nakor 0:2743c73d648d 222
Nakor 0:2743c73d648d 223 }
Nakor 6:c0ebd0f8f873 224 #endif
Nakor 0:2743c73d648d 225
Nakor 7:229fc175e05e 226 }
Nakor 7:229fc175e05e 227
Nakor 7:229fc175e05e 228 void trackballer::reset()
Nakor 7:229fc175e05e 229 {
Nakor 7:229fc175e05e 230 _xPosition = 0.5;
Nakor 7:229fc175e05e 231 _yPosition = 0.5;
Nakor 0:2743c73d648d 232 }