Charles Young's development fork. Going forward I only want to push mature code to main repository.
Fork of GEO_COUNTER_L432KC by
main.cpp@17:6eed17197004, 2018-09-03 (annotated)
- Committer:
- charlesdavidyoung
- Date:
- Mon Sep 03 17:31:41 2018 +0000
- Revision:
- 17:6eed17197004
- Parent:
- 16:b2e77eb76ab4
- Child:
- 18:ef5678ab1889
State machine implemented. Still need timeouts.
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
walter76 | 2:ac0ed3d84d44 | 1 | // GEO COUNTER V1 firmware |
walter76 | 2:ac0ed3d84d44 | 2 | // This FW provides a basic operation of GEO-COUNTER |
walter76 | 2:ac0ed3d84d44 | 3 | // |
walter76 | 2:ac0ed3d84d44 | 4 | // Latest review: August 27, 2018 - Walter Trovo |
walter76 | 1:75827d765e34 | 5 | // |
walter76 | 1:75827d765e34 | 6 | // Feb 14, 2018: initial release aimed to test the counters, the serial port |
walter76 | 1:75827d765e34 | 7 | // the PWM output and the MAX7219 operation. |
walter76 | 1:75827d765e34 | 8 | // Feb 15, 2018: Removed MAX7219 libray (replaced with custom routine). |
walter76 | 1:75827d765e34 | 9 | // Added 74HC595 routine. Added beep. Added Gate_write |
walter76 | 1:75827d765e34 | 10 | // |
walter76 | 2:ac0ed3d84d44 | 11 | |
walter76 | 1:75827d765e34 | 12 | |
walter76 | 1:75827d765e34 | 13 | // this block includes key libraries |
walter76 | 1:75827d765e34 | 14 | #include "mbed.h" // global Mbed library (always needed) |
walter76 | 1:75827d765e34 | 15 | #include <string> // strings management |
walter76 | 1:75827d765e34 | 16 | #include "QEI.h" // Quadrature Encoder functions |
walter76 | 1:75827d765e34 | 17 | |
walter76 | 1:75827d765e34 | 18 | // definitions of fixed parameters |
walter76 | 0:6d1742703713 | 19 | |
walter76 | 1:75827d765e34 | 20 | #define DEC_MODE 0x09FF // BCD decoding on all digits |
walter76 | 1:75827d765e34 | 21 | #define BRIGHTNESS 0x0A0F // max brightness |
walter76 | 1:75827d765e34 | 22 | #define SCAN_LIM 0x0B07 // use all 8 digits |
walter76 | 1:75827d765e34 | 23 | #define TURN_ON 0x0C01 // no shutdown (operating) |
walter76 | 1:75827d765e34 | 24 | #define SHUTDOWN 0x0C00 // shutdown |
walter76 | 1:75827d765e34 | 25 | #define TEST 0x0F00 // no test |
walter76 | 1:75827d765e34 | 26 | |
walter76 | 1:75827d765e34 | 27 | #define DT 1 // delay time in us for SPI emulation |
walter76 | 1:75827d765e34 | 28 | |
walter76 | 1:75827d765e34 | 29 | #define TGATE 10 // gate time (currently fixed for testing purpose) |
walter76 | 1:75827d765e34 | 30 | #define MAX_VAL 999999 // Max value managed by the 6-digits display |
walter76 | 0:6d1742703713 | 31 | |
walter76 | 1:75827d765e34 | 32 | |
walter76 | 1:75827d765e34 | 33 | #define CPM 0x01 |
walter76 | 1:75827d765e34 | 34 | #define CPS 0x02 |
walter76 | 1:75827d765e34 | 35 | #define PLS 0x04 |
walter76 | 1:75827d765e34 | 36 | #define VOLTS 0x08 |
walter76 | 1:75827d765e34 | 37 | #define CNT1 0x10 |
walter76 | 1:75827d765e34 | 38 | #define CNT2 0x20 |
walter76 | 1:75827d765e34 | 39 | #define HV 0x40 |
walter76 | 1:75827d765e34 | 40 | #define MENU 0x80 |
charlesdavidyoung | 13:0e7b06af9a2a | 41 | uint8_t LED_statuses[] = {CPM, CPS, PLS, VOLTS, CNT1, CNT2, HV, MENU}; |
Charles David Young |
7:9f975e00600c | 42 | uint8_t LED_status = CPM; |
Charles David Young |
7:9f975e00600c | 43 | uint8_t LED_status_index = 0; |
walter76 | 1:75827d765e34 | 44 | |
walter76 | 1:75827d765e34 | 45 | // definitions of the input/outputs (pins) |
walter76 | 1:75827d765e34 | 46 | DigitalOut AUX (D2); // AUX control for GPS module |
walter76 | 0:6d1742703713 | 47 | InterruptIn TRIG1 (D3); // Counter 1 trigger |
walter76 | 0:6d1742703713 | 48 | InterruptIn TRIG2 (D6); // Counter 2 trigger |
charlesdavidyoung | 15:808e98afe32b | 49 | DigitalIn QEPB (D9); // Quadrature encoder pushbutton |
walter76 | 0:6d1742703713 | 50 | PwmOut PWM (D10); // PWM output |
walter76 | 1:75827d765e34 | 51 | DigitalOut BUZZ (D13); // Buzzer |
walter76 | 0:6d1742703713 | 52 | |
walter76 | 1:75827d765e34 | 53 | AnalogIn AIN0 (A0); // ADC input 0 (High Voltage) |
walter76 | 1:75827d765e34 | 54 | AnalogIn AIN1 (A1); // ADC input 1 (aux) |
walter76 | 1:75827d765e34 | 55 | DigitalOut CS2 (A2); // 74HC595 RCLK (pin 12) |
walter76 | 1:75827d765e34 | 56 | DigitalOut CS1 (A3); // MAX7219 CS (pin 12) |
walter76 | 1:75827d765e34 | 57 | DigitalOut SCK (A4); // 74HC595 SRCLK (pin 11) & MAX7219 SCK (pin 13) |
walter76 | 1:75827d765e34 | 58 | AnalogIn KEYB (A5); // Keyboard input (SW2 & SW3) |
walter76 | 1:75827d765e34 | 59 | DigitalOut MOSI (A6); // 74HC595 SER (pin 14) & MAX7219 DIN (pin 1) |
walter76 | 1:75827d765e34 | 60 | DigitalIn UN (A7); // Unused (in V1 PCB A5 and A7 must be connected) |
walter76 | 1:75827d765e34 | 61 | |
charlesdavidyoung | 5:4f90b458dbdf | 62 | // LED on processor board |
charlesdavidyoung | 5:4f90b458dbdf | 63 | DigitalOut led1(LED1); |
walter76 | 1:75827d765e34 | 64 | |
walter76 | 1:75827d765e34 | 65 | // definitions of peripherals and devices |
Charles David Young |
7:9f975e00600c | 66 | |
Charles David Young |
7:9f975e00600c | 67 | // QEI class supports the mode wheel. In its most basic function it will tell |
Charles David Young |
7:9f975e00600c | 68 | // us which direction the wheel is moving (right or left) so that we can |
Charles David Young |
7:9f975e00600c | 69 | // use it to select the current mode. |
walter76 | 1:75827d765e34 | 70 | QEI Wheel(D12, D11, NC, 16); // Quadrature encoder |
Charles David Young |
7:9f975e00600c | 71 | int WheelCurrent = 0; |
Charles David Young |
7:9f975e00600c | 72 | int WheelPrevious = 0; |
Charles David Young |
16:b2e77eb76ab4 | 73 | bool QEPBpressed = false; // only react to button when pressed |
Charles David Young |
16:b2e77eb76ab4 | 74 | enum WheelState { |
Charles David Young |
16:b2e77eb76ab4 | 75 | WHEEL_INACTIVE = 0, |
Charles David Young |
16:b2e77eb76ab4 | 76 | WHEEL_MODE_SELECT = 1, |
Charles David Young |
16:b2e77eb76ab4 | 77 | WHEEL_SUBMODE_SELECT = 2 |
Charles David Young |
16:b2e77eb76ab4 | 78 | }; |
Charles David Young |
16:b2e77eb76ab4 | 79 | enum WheelStateEvent { |
Charles David Young |
16:b2e77eb76ab4 | 80 | WHEEL_Pressed = 0, |
Charles David Young |
16:b2e77eb76ab4 | 81 | WHEEL_Timeout = 1 |
Charles David Young |
16:b2e77eb76ab4 | 82 | }; |
Charles David Young |
16:b2e77eb76ab4 | 83 | WheelState currentWheelState; |
Charles David Young |
7:9f975e00600c | 84 | |
charlesdavidyoung | 17:6eed17197004 | 85 | I2C i2c(D4, D5); // I2C port |
charlesdavidyoung | 17:6eed17197004 | 86 | Ticker SecTenth_Beat; // .1 second ticker |
walter76 | 1:75827d765e34 | 87 | Ticker Sec_Beat; // 1 second ticker |
walter76 | 1:75827d765e34 | 88 | Serial PC(USBTX, USBRX); // Virtual COM via USB (PC connection) |
walter76 | 1:75827d765e34 | 89 | Serial GPS(D1, D0); // Serial port for GPS module |
walter76 | 0:6d1742703713 | 90 | |
walter76 | 0:6d1742703713 | 91 | // Global variables |
walter76 | 1:75827d765e34 | 92 | uint8_t Disp_Digit[8]; // used to manage 8-digits through MAX7219 |
walter76 | 1:75827d765e34 | 93 | uint16_t Stream; // used to stream out serial data to MAX7219 |
walter76 | 1:75827d765e34 | 94 | time_t seconds; // Real-Time Clock (RTC) timestamp |
walter76 | 1:75827d765e34 | 95 | unsigned int value = 0; // displayed value on the 6-digits of the display |
walter76 | 1:75827d765e34 | 96 | uint8_t gate = TGATE; // displayed value on the 2-digits display |
walter76 | 1:75827d765e34 | 97 | uint32_t Count1, Count2; // pulse counters (32-bit) |
walter76 | 1:75827d765e34 | 98 | char Text[40]=""; // used to send messages over the serial port |
walter76 | 1:75827d765e34 | 99 | uint8_t Disp_mode = 0x01, Disp_unit = 0xA0; // status of 1st row and 2nd rows of LEDs |
kd5byb | 4:b17c6556cf1f | 100 | bool Stopped = 0; // status of counting activity |
charlesdavidyoung | 5:4f90b458dbdf | 101 | bool StartStopPressed = 0;// status of counting activity |
walter76 | 1:75827d765e34 | 102 | double ADC_val; // used to read ADC value |
walter76 | 0:6d1742703713 | 103 | |
walter76 | 1:75827d765e34 | 104 | // ----- Prototypes of routines (defined below the main) ------------------- |
Charles David Young |
16:b2e77eb76ab4 | 105 | void UpdateInput(void); // periodically called by the ticker |
Charles David Young |
16:b2e77eb76ab4 | 106 | void UpdateOutput(void); // periodically called by the ticker |
walter76 | 1:75827d765e34 | 107 | void Count1_up(void); // called every time an edge is detected on TRIG1 pin |
walter76 | 1:75827d765e34 | 108 | void Count2_up(void); // called every time an edge is detected on TRIG2 pin |
walter76 | 1:75827d765e34 | 109 | void Beep(void); // used to generate a short beep (buzzer) |
walter76 | 1:75827d765e34 | 110 | void LEDs_write(unsigned short); // write to 74HC595 (8x LEDs) |
walter76 | 1:75827d765e34 | 111 | void Display_init(void); // initialize MAX7219 |
walter76 | 1:75827d765e34 | 112 | void Display_6D_write(uint8_t); // write to MAX7219 (Main 6-digits display) |
walter76 | 1:75827d765e34 | 113 | void Display_2D_write(unsigned short); // write to MAX7219 (Gate 2-digits display) |
charlesdavidyoung | 17:6eed17197004 | 114 | void WheelStateMachine(WheelStateEvent event); |
walter76 | 0:6d1742703713 | 115 | |
walter76 | 0:6d1742703713 | 116 | //============================================================================== |
walter76 | 0:6d1742703713 | 117 | //============================================================================== |
walter76 | 0:6d1742703713 | 118 | |
walter76 | 0:6d1742703713 | 119 | int main() |
walter76 | 0:6d1742703713 | 120 | { |
walter76 | 0:6d1742703713 | 121 | |
walter76 | 1:75827d765e34 | 122 | PC.baud(115200); // set baud-rate of virtual COM port (PC connection) |
charlesdavidyoung | 5:4f90b458dbdf | 123 | PC.printf("\nGEO COUNTER V1 2108"); |
walter76 | 1:75827d765e34 | 124 | PC.printf(__DATE__); |
walter76 | 1:75827d765e34 | 125 | PC.printf(" "); |
walter76 | 1:75827d765e34 | 126 | PC.printf(__TIME__); |
walter76 | 1:75827d765e34 | 127 | |
walter76 | 2:ac0ed3d84d44 | 128 | GPS.baud(9600); // set the baud-rate of the serial port dedicated to the GPS |
walter76 | 0:6d1742703713 | 129 | |
walter76 | 1:75827d765e34 | 130 | CS1 = 1; // presets CS of MAX7219 |
walter76 | 1:75827d765e34 | 131 | CS2 = 1; // preset CS of 74HC595 |
walter76 | 1:75827d765e34 | 132 | |
charlesdavidyoung | 13:0e7b06af9a2a | 133 | Display_6D_write(0x543210); |
walter76 | 1:75827d765e34 | 134 | Display_2D_write(TGATE); |
walter76 | 1:75827d765e34 | 135 | Display_init(); // initialize MAX7219 |
walter76 | 0:6d1742703713 | 136 | |
walter76 | 1:75827d765e34 | 137 | // RTC is supposed to be loose time at power down (no backup battery) |
walter76 | 1:75827d765e34 | 138 | // An initialization is performed anyway |
walter76 | 1:75827d765e34 | 139 | set_time(0); // Set time |
walter76 | 0:6d1742703713 | 140 | |
walter76 | 1:75827d765e34 | 141 | Wheel.reset(); // clear the variable associated to the encoder |
walter76 | 1:75827d765e34 | 142 | |
walter76 | 1:75827d765e34 | 143 | PWM.period_ms(3); // set the PWM period |
walter76 | 1:75827d765e34 | 144 | PWM.write(0.8); // set the PWM duty-cycle |
walter76 | 1:75827d765e34 | 145 | |
walter76 | 1:75827d765e34 | 146 | LEDs_write(0x00); // initialize LEDs (CPM and CNT1 on) |
walter76 | 1:75827d765e34 | 147 | Beep(); // initial beep |
walter76 | 1:75827d765e34 | 148 | |
walter76 | 1:75827d765e34 | 149 | // set the 1 sec ticker to periodically call the Update() routine |
walter76 | 1:75827d765e34 | 150 | // NOTE: this is also the 1-sec time base for counters. A better approach |
walter76 | 1:75827d765e34 | 151 | // would replace the ticker with an interrupt from the RTC (to be implemented) |
charlesdavidyoung | 17:6eed17197004 | 152 | SecTenth_Beat.attach_us(&UpdateInput, 100000); |
Charles David Young |
16:b2e77eb76ab4 | 153 | Sec_Beat.attach_us(&UpdateOutput, 1000000); |
walter76 | 0:6d1742703713 | 154 | //RTC::attach(&Update, RTC::Second); |
walter76 | 1:75827d765e34 | 155 | //RTC::detach(RTC::Second); |
walter76 | 1:75827d765e34 | 156 | |
walter76 | 1:75827d765e34 | 157 | // main loop does nothing as all activities are interrupt driven |
walter76 | 0:6d1742703713 | 158 | while(1) |
walter76 | 0:6d1742703713 | 159 | { |
walter76 | 2:ac0ed3d84d44 | 160 | // dance (or drink a beer) |
walter76 | 0:6d1742703713 | 161 | } |
walter76 | 0:6d1742703713 | 162 | } |
walter76 | 0:6d1742703713 | 163 | |
walter76 | 0:6d1742703713 | 164 | |
walter76 | 1:75827d765e34 | 165 | //-------- END OF MAIN -------------- |
walter76 | 0:6d1742703713 | 166 | //============================================================================== |
walter76 | 0:6d1742703713 | 167 | |
walter76 | 1:75827d765e34 | 168 | // Definition of routines |
walter76 | 1:75827d765e34 | 169 | |
walter76 | 1:75827d765e34 | 170 | //--------------------------------------------------------------------------- |
walter76 | 1:75827d765e34 | 171 | // Update values to be displayed |
Charles David Young |
10:f48cc6be5ae8 | 172 | void logToPC() |
Charles David Young |
10:f48cc6be5ae8 | 173 | { |
Charles David Young |
10:f48cc6be5ae8 | 174 | PC.printf("\nADC: %.02f", ADC_val); |
Charles David Young |
10:f48cc6be5ae8 | 175 | PC.printf(Stopped ? " stopped" : " started"); |
Charles David Young |
10:f48cc6be5ae8 | 176 | // Timestamp to PC (debug) |
Charles David Young |
10:f48cc6be5ae8 | 177 | seconds = time(NULL); // get current time |
Charles David Young |
10:f48cc6be5ae8 | 178 | strftime(Text, 50, "%H:%M:%S", localtime(&seconds)); |
Charles David Young |
10:f48cc6be5ae8 | 179 | PC.printf(" RTC: %s, CNT1: %7d CNT2: %7d",Text, Count1, Count2); |
charlesdavidyoung | 15:808e98afe32b | 180 | PC.printf(" wheel %d %d", WheelCurrent, QEPB.read()); |
Charles David Young |
10:f48cc6be5ae8 | 181 | } |
walter76 | 1:75827d765e34 | 182 | |
Charles David Young |
16:b2e77eb76ab4 | 183 | void UpdateOutput() |
walter76 | 1:75827d765e34 | 184 | { |
Charles David Young |
16:b2e77eb76ab4 | 185 | if(Stopped) |
Charles David Young |
16:b2e77eb76ab4 | 186 | { |
Charles David Young |
16:b2e77eb76ab4 | 187 | // disable interrupts on TRIG1 and TRIG2 |
Charles David Young |
16:b2e77eb76ab4 | 188 | |
Charles David Young |
16:b2e77eb76ab4 | 189 | TRIG1.rise(NULL); |
Charles David Young |
16:b2e77eb76ab4 | 190 | TRIG2.rise(NULL); |
Charles David Young |
16:b2e77eb76ab4 | 191 | |
Charles David Young |
16:b2e77eb76ab4 | 192 | // show zero gate time |
Charles David Young |
16:b2e77eb76ab4 | 193 | gate = 0; |
Charles David Young |
16:b2e77eb76ab4 | 194 | Display_2D_write(gate); |
Charles David Young |
16:b2e77eb76ab4 | 195 | |
Charles David Young |
16:b2e77eb76ab4 | 196 | // show selected content on main display |
Charles David Young |
16:b2e77eb76ab4 | 197 | value = (int)(Count1/TGATE); |
Charles David Young |
16:b2e77eb76ab4 | 198 | Display_6D_write(value); // refresh the main display |
Charles David Young |
16:b2e77eb76ab4 | 199 | } |
Charles David Young |
16:b2e77eb76ab4 | 200 | |
Charles David Young |
16:b2e77eb76ab4 | 201 | else |
Charles David Young |
16:b2e77eb76ab4 | 202 | { |
Charles David Young |
16:b2e77eb76ab4 | 203 | // Enable interrupts on rising edge of digital inputs TRIG1 & TRIG2 |
Charles David Young |
16:b2e77eb76ab4 | 204 | TRIG1.rise(&Count1_up); |
Charles David Young |
16:b2e77eb76ab4 | 205 | TRIG2.rise(&Count2_up); |
Charles David Young |
16:b2e77eb76ab4 | 206 | |
Charles David Young |
16:b2e77eb76ab4 | 207 | if(gate==0) // show the counter value at the end of the gate time |
Charles David Young |
16:b2e77eb76ab4 | 208 | { |
Charles David Young |
16:b2e77eb76ab4 | 209 | value = (int)(Count1/TGATE); |
Charles David Young |
16:b2e77eb76ab4 | 210 | |
Charles David Young |
16:b2e77eb76ab4 | 211 | Display_6D_write(value); // refresh the main display |
Charles David Young |
7:9f975e00600c | 212 | |
Charles David Young |
16:b2e77eb76ab4 | 213 | Count1 = 0; // clear both counters |
Charles David Young |
16:b2e77eb76ab4 | 214 | Count2 = 0; |
Charles David Young |
16:b2e77eb76ab4 | 215 | gate = TGATE;// and reload the gate time |
Charles David Young |
16:b2e77eb76ab4 | 216 | |
Charles David Young |
16:b2e77eb76ab4 | 217 | } |
Charles David Young |
16:b2e77eb76ab4 | 218 | |
Charles David Young |
16:b2e77eb76ab4 | 219 | Display_2D_write(gate); // show gate time countdown |
Charles David Young |
16:b2e77eb76ab4 | 220 | gate--; |
Charles David Young |
16:b2e77eb76ab4 | 221 | } |
Charles David Young |
16:b2e77eb76ab4 | 222 | } |
Charles David Young |
16:b2e77eb76ab4 | 223 | |
Charles David Young |
16:b2e77eb76ab4 | 224 | void UpdateInput() |
Charles David Young |
16:b2e77eb76ab4 | 225 | { |
Charles David Young |
16:b2e77eb76ab4 | 226 | LEDs_write(LED_statuses[LED_status_index]); |
Charles David Young |
16:b2e77eb76ab4 | 227 | |
Charles David Young |
16:b2e77eb76ab4 | 228 | ADC_val = KEYB.read(); // read voltage from keyboard |
Charles David Young |
16:b2e77eb76ab4 | 229 | if ( (ADC_val<0.1) // START/STOP pushbutton pressed |
Charles David Young |
16:b2e77eb76ab4 | 230 | && (!StartStopPressed)) |
Charles David Young |
16:b2e77eb76ab4 | 231 | { |
Charles David Young |
16:b2e77eb76ab4 | 232 | StartStopPressed = true; |
Charles David Young |
16:b2e77eb76ab4 | 233 | Stopped=!Stopped; // toggle status |
Charles David Young |
16:b2e77eb76ab4 | 234 | } |
Charles David Young |
16:b2e77eb76ab4 | 235 | else |
Charles David Young |
16:b2e77eb76ab4 | 236 | StartStopPressed = false; |
charlesdavidyoung | 5:4f90b458dbdf | 237 | |
Charles David Young |
16:b2e77eb76ab4 | 238 | if((ADC_val>0.6)&&(ADC_val<0.7)) // CLEAR pushbutton pressed |
Charles David Young |
16:b2e77eb76ab4 | 239 | { |
Charles David Young |
16:b2e77eb76ab4 | 240 | Count1 = 0; // clear counters |
Charles David Young |
16:b2e77eb76ab4 | 241 | Count2 = 0; |
charlesdavidyoung | 5:4f90b458dbdf | 242 | } |
charlesdavidyoung | 5:4f90b458dbdf | 243 | |
Charles David Young |
16:b2e77eb76ab4 | 244 | if ( (WHEEL_MODE_SELECT == currentWheelState) |
Charles David Young |
16:b2e77eb76ab4 | 245 | || (WHEEL_SUBMODE_SELECT == currentWheelState)) |
Charles David Young |
16:b2e77eb76ab4 | 246 | { |
Charles David Young |
16:b2e77eb76ab4 | 247 | WheelCurrent = int(Wheel.getPulses()); |
Charles David Young |
16:b2e77eb76ab4 | 248 | if (WheelCurrent > WheelPrevious) |
Charles David Young |
16:b2e77eb76ab4 | 249 | LED_status_index = ++LED_status_index % sizeof(LED_statuses); |
Charles David Young |
16:b2e77eb76ab4 | 250 | else |
Charles David Young |
16:b2e77eb76ab4 | 251 | if (WheelCurrent < WheelPrevious) |
Charles David Young |
16:b2e77eb76ab4 | 252 | LED_status_index = --LED_status_index % sizeof(LED_statuses); |
Charles David Young |
16:b2e77eb76ab4 | 253 | WheelPrevious = WheelCurrent; |
Charles David Young |
16:b2e77eb76ab4 | 254 | } |
Charles David Young |
16:b2e77eb76ab4 | 255 | |
Charles David Young |
16:b2e77eb76ab4 | 256 | // detect when wheel button is pressed but wait until it is released |
Charles David Young |
16:b2e77eb76ab4 | 257 | // before doing anything |
Charles David Young |
16:b2e77eb76ab4 | 258 | bool QEPBbutton = QEPB.read(); |
Charles David Young |
16:b2e77eb76ab4 | 259 | if ( (QEPBbutton) |
Charles David Young |
16:b2e77eb76ab4 | 260 | && (!QEPBpressed)) |
Charles David Young |
16:b2e77eb76ab4 | 261 | { |
Charles David Young |
16:b2e77eb76ab4 | 262 | QEPBpressed = true; |
Charles David Young |
16:b2e77eb76ab4 | 263 | } |
Charles David Young |
16:b2e77eb76ab4 | 264 | else |
Charles David Young |
16:b2e77eb76ab4 | 265 | if ( (!QEPBbutton) |
Charles David Young |
16:b2e77eb76ab4 | 266 | && (QEPBpressed)) |
Charles David Young |
16:b2e77eb76ab4 | 267 | { |
Charles David Young |
16:b2e77eb76ab4 | 268 | QEPBpressed = false; |
Charles David Young |
16:b2e77eb76ab4 | 269 | WheelStateMachine(WHEEL_Pressed); |
Charles David Young |
16:b2e77eb76ab4 | 270 | } |
walter76 | 0:6d1742703713 | 271 | |
Charles David Young |
16:b2e77eb76ab4 | 272 | logToPC(); |
Charles David Young |
16:b2e77eb76ab4 | 273 | return; |
Charles David Young |
16:b2e77eb76ab4 | 274 | } |
walter76 | 1:75827d765e34 | 275 | |
Charles David Young |
16:b2e77eb76ab4 | 276 | void WheelStateMachine(WheelStateEvent event) |
Charles David Young |
16:b2e77eb76ab4 | 277 | { |
charlesdavidyoung | 17:6eed17197004 | 278 | switch (currentWheelState) { |
charlesdavidyoung | 17:6eed17197004 | 279 | case WHEEL_INACTIVE: |
Charles David Young |
16:b2e77eb76ab4 | 280 | if (WHEEL_Pressed == event) |
Charles David Young |
16:b2e77eb76ab4 | 281 | currentWheelState = WHEEL_MODE_SELECT; |
Charles David Young |
16:b2e77eb76ab4 | 282 | break; |
charlesdavidyoung | 17:6eed17197004 | 283 | case WHEEL_MODE_SELECT: |
Charles David Young |
16:b2e77eb76ab4 | 284 | if (WHEEL_Pressed == event) |
Charles David Young |
16:b2e77eb76ab4 | 285 | currentWheelState = WHEEL_SUBMODE_SELECT; |
Charles David Young |
16:b2e77eb76ab4 | 286 | else |
Charles David Young |
16:b2e77eb76ab4 | 287 | if (WHEEL_Timeout == event) |
Charles David Young |
16:b2e77eb76ab4 | 288 | currentWheelState = WHEEL_INACTIVE; |
Charles David Young |
16:b2e77eb76ab4 | 289 | break; |
charlesdavidyoung | 17:6eed17197004 | 290 | case WHEEL_SUBMODE_SELECT: |
Charles David Young |
16:b2e77eb76ab4 | 291 | if (WHEEL_Pressed == event) |
Charles David Young |
16:b2e77eb76ab4 | 292 | currentWheelState = WHEEL_MODE_SELECT; |
Charles David Young |
16:b2e77eb76ab4 | 293 | else |
Charles David Young |
16:b2e77eb76ab4 | 294 | if (WHEEL_Timeout == event) |
Charles David Young |
16:b2e77eb76ab4 | 295 | currentWheelState = WHEEL_INACTIVE; |
Charles David Young |
16:b2e77eb76ab4 | 296 | break; |
Charles David Young |
16:b2e77eb76ab4 | 297 | default: |
charlesdavidyoung | 17:6eed17197004 | 298 | break; |
Charles David Young |
16:b2e77eb76ab4 | 299 | } |
walter76 | 0:6d1742703713 | 300 | } |
walter76 | 0:6d1742703713 | 301 | |
walter76 | 0:6d1742703713 | 302 | //--------------------------------------------------------------------------- |
walter76 | 1:75827d765e34 | 303 | // Increment CNT1 every time a rising edge is detected on TRIG1 (interrupt) |
walter76 | 1:75827d765e34 | 304 | |
walter76 | 1:75827d765e34 | 305 | void Count1_up(void) |
walter76 | 1:75827d765e34 | 306 | { |
walter76 | 1:75827d765e34 | 307 | Count1++; |
walter76 | 1:75827d765e34 | 308 | return; |
walter76 | 1:75827d765e34 | 309 | } |
walter76 | 1:75827d765e34 | 310 | |
walter76 | 1:75827d765e34 | 311 | |
walter76 | 1:75827d765e34 | 312 | //--------------------------------------------------------------------------- |
walter76 | 1:75827d765e34 | 313 | // Increment CNT1 every time a rising edge is detected on TRIG2 (interrupt) |
walter76 | 1:75827d765e34 | 314 | |
walter76 | 1:75827d765e34 | 315 | void Count2_up(void) |
walter76 | 1:75827d765e34 | 316 | { |
walter76 | 1:75827d765e34 | 317 | Count2++; |
walter76 | 1:75827d765e34 | 318 | return; |
walter76 | 1:75827d765e34 | 319 | } |
walter76 | 1:75827d765e34 | 320 | |
walter76 | 1:75827d765e34 | 321 | |
walter76 | 1:75827d765e34 | 322 | //--------------------------------------------------------------------------- |
walter76 | 1:75827d765e34 | 323 | //Generates a short beep via BUZZ |
walter76 | 1:75827d765e34 | 324 | |
walter76 | 1:75827d765e34 | 325 | void Beep(void) |
walter76 | 1:75827d765e34 | 326 | { |
walter76 | 1:75827d765e34 | 327 | BUZZ = 1; // turn-on the buzzer |
walter76 | 1:75827d765e34 | 328 | wait(0.3); // wait |
walter76 | 1:75827d765e34 | 329 | BUZZ = 0; // turn-off the buzzer |
walter76 | 0:6d1742703713 | 330 | return; |
walter76 | 0:6d1742703713 | 331 | } |
walter76 | 0:6d1742703713 | 332 | |
walter76 | 0:6d1742703713 | 333 | |
walter76 | 0:6d1742703713 | 334 | //--------------------------------------------------------------------------- |
walter76 | 1:75827d765e34 | 335 | //Write to 74HC595 (LEDs) - Take care to avoid conflict with MAX7219 |
walter76 | 1:75827d765e34 | 336 | |
walter76 | 1:75827d765e34 | 337 | void LEDs_write(unsigned short data_val) |
walter76 | 1:75827d765e34 | 338 | { |
walter76 | 1:75827d765e34 | 339 | // Update 74HC595 shift registers |
walter76 | 1:75827d765e34 | 340 | unsigned short mask; |
walter76 | 1:75827d765e34 | 341 | |
walter76 | 1:75827d765e34 | 342 | SCK = 0; |
walter76 | 1:75827d765e34 | 343 | wait_us(DT); |
walter76 | 1:75827d765e34 | 344 | CS2 = 0; |
walter76 | 1:75827d765e34 | 345 | |
walter76 | 1:75827d765e34 | 346 | for(mask = 0x80; mask!= 0; mask>>= 1) |
walter76 | 1:75827d765e34 | 347 | { |
walter76 | 1:75827d765e34 | 348 | wait_us(DT); |
walter76 | 1:75827d765e34 | 349 | SCK = 0; |
walter76 | 1:75827d765e34 | 350 | if(mask & data_val) |
walter76 | 1:75827d765e34 | 351 | MOSI = 0; |
walter76 | 1:75827d765e34 | 352 | else |
walter76 | 1:75827d765e34 | 353 | MOSI = 1; |
walter76 | 1:75827d765e34 | 354 | wait_us(DT); |
walter76 | 1:75827d765e34 | 355 | SCK = 1; |
walter76 | 1:75827d765e34 | 356 | } |
walter76 | 1:75827d765e34 | 357 | |
walter76 | 1:75827d765e34 | 358 | SCK = 0; |
walter76 | 1:75827d765e34 | 359 | wait_us(DT); |
walter76 | 1:75827d765e34 | 360 | CS2 = 1; |
walter76 | 1:75827d765e34 | 361 | |
walter76 | 0:6d1742703713 | 362 | return; |
walter76 | 0:6d1742703713 | 363 | } |
walter76 | 0:6d1742703713 | 364 | |
walter76 | 0:6d1742703713 | 365 | |
walter76 | 1:75827d765e34 | 366 | //--------------------------------------------------------------------------- |
walter76 | 1:75827d765e34 | 367 | // Initialize the MAX7219 |
walter76 | 1:75827d765e34 | 368 | |
walter76 | 1:75827d765e34 | 369 | void Display_init(void) |
walter76 | 1:75827d765e34 | 370 | { |
walter76 | 1:75827d765e34 | 371 | uint8_t i; |
walter76 | 1:75827d765e34 | 372 | uint16_t mask; |
walter76 | 1:75827d765e34 | 373 | uint16_t data_to_send[6] = {SHUTDOWN, TURN_ON, DEC_MODE, BRIGHTNESS, SCAN_LIM, TEST}; |
walter76 | 1:75827d765e34 | 374 | //{SHUTDOWN, TURN_ON, DEC_MODE, BRIGHTNESS, SCAN_LIM, TEST}; |
walter76 | 1:75827d765e34 | 375 | for(i = 0; i <6; i++) |
walter76 | 1:75827d765e34 | 376 | { |
walter76 | 1:75827d765e34 | 377 | CS1 = 0; |
walter76 | 1:75827d765e34 | 378 | |
walter76 | 1:75827d765e34 | 379 | for(mask = 0x8000; mask!= 0; mask>>= 1) |
walter76 | 1:75827d765e34 | 380 | { |
walter76 | 1:75827d765e34 | 381 | wait_us(DT); |
walter76 | 1:75827d765e34 | 382 | SCK = 0; |
walter76 | 1:75827d765e34 | 383 | if(mask & data_to_send[i]) |
walter76 | 1:75827d765e34 | 384 | MOSI = 1; |
walter76 | 1:75827d765e34 | 385 | else |
walter76 | 1:75827d765e34 | 386 | MOSI = 0; |
walter76 | 1:75827d765e34 | 387 | wait_us(DT); |
walter76 | 1:75827d765e34 | 388 | SCK = 1; |
walter76 | 1:75827d765e34 | 389 | } |
walter76 | 1:75827d765e34 | 390 | |
walter76 | 1:75827d765e34 | 391 | wait_us(DT); |
walter76 | 1:75827d765e34 | 392 | SCK = 0; |
walter76 | 1:75827d765e34 | 393 | wait_us(DT); |
walter76 | 1:75827d765e34 | 394 | CS1 = 1; |
walter76 | 1:75827d765e34 | 395 | } |
walter76 | 1:75827d765e34 | 396 | |
walter76 | 1:75827d765e34 | 397 | return; |
walter76 | 1:75827d765e34 | 398 | } |
walter76 | 1:75827d765e34 | 399 | |
walter76 | 1:75827d765e34 | 400 | |
walter76 | 1:75827d765e34 | 401 | //--------------------------------------------------------------------------- |
walter76 | 1:75827d765e34 | 402 | // Refresh the 6 digits of the main display |
walter76 | 1:75827d765e34 | 403 | |
walter76 | 1:75827d765e34 | 404 | void Display_6D_write(uint8_t value) |
walter76 | 1:75827d765e34 | 405 | { |
walter76 | 1:75827d765e34 | 406 | |
walter76 | 1:75827d765e34 | 407 | uint8_t digit; |
walter76 | 1:75827d765e34 | 408 | uint16_t mask, data_to_send; |
walter76 | 1:75827d765e34 | 409 | char TextString[6]; |
walter76 | 1:75827d765e34 | 410 | |
walter76 | 1:75827d765e34 | 411 | // int to string, then string to digits |
walter76 | 1:75827d765e34 | 412 | |
walter76 | 1:75827d765e34 | 413 | sprintf(TextString, "%6d", value); // int to string |
walter76 | 1:75827d765e34 | 414 | |
walter76 | 1:75827d765e34 | 415 | for(uint8_t i=0; i<6; i++) |
walter76 | 1:75827d765e34 | 416 | { |
walter76 | 1:75827d765e34 | 417 | if(TextString[i] == ' ') // blank empty digits |
walter76 | 1:75827d765e34 | 418 | Disp_Digit[i] = 0xFF; |
walter76 | 1:75827d765e34 | 419 | else |
walter76 | 1:75827d765e34 | 420 | Disp_Digit[i] = TextString[i]-'0'; |
walter76 | 1:75827d765e34 | 421 | } |
walter76 | 1:75827d765e34 | 422 | |
walter76 | 1:75827d765e34 | 423 | // write to chip |
walter76 | 1:75827d765e34 | 424 | |
walter76 | 1:75827d765e34 | 425 | SCK = 0; |
walter76 | 1:75827d765e34 | 426 | wait_us(DT); |
walter76 | 1:75827d765e34 | 427 | |
walter76 | 1:75827d765e34 | 428 | for(digit = 1; digit <7; digit++) |
walter76 | 1:75827d765e34 | 429 | { |
walter76 | 1:75827d765e34 | 430 | // each stream consists of digit address and data to show |
Charles David Young |
6:05201ecabb95 | 431 | data_to_send = 7 - digit; |
walter76 | 1:75827d765e34 | 432 | data_to_send<<=8; |
walter76 | 1:75827d765e34 | 433 | data_to_send = data_to_send | Disp_Digit[digit-1]; |
walter76 | 1:75827d765e34 | 434 | |
walter76 | 1:75827d765e34 | 435 | CS1 = 0; |
walter76 | 1:75827d765e34 | 436 | |
walter76 | 1:75827d765e34 | 437 | for(mask = 0x8000; mask!= 0; mask>>= 1) |
walter76 | 1:75827d765e34 | 438 | { |
walter76 | 1:75827d765e34 | 439 | wait_us(DT); |
walter76 | 1:75827d765e34 | 440 | SCK = 0; |
walter76 | 1:75827d765e34 | 441 | if(mask & data_to_send) |
walter76 | 1:75827d765e34 | 442 | MOSI = 1; |
walter76 | 1:75827d765e34 | 443 | else |
walter76 | 1:75827d765e34 | 444 | MOSI = 0; |
walter76 | 1:75827d765e34 | 445 | |
walter76 | 1:75827d765e34 | 446 | wait_us(DT); |
walter76 | 1:75827d765e34 | 447 | SCK = 1; |
walter76 | 1:75827d765e34 | 448 | } |
walter76 | 1:75827d765e34 | 449 | |
walter76 | 1:75827d765e34 | 450 | wait_us(DT); |
walter76 | 1:75827d765e34 | 451 | SCK = 0; |
walter76 | 1:75827d765e34 | 452 | wait_us(DT); |
walter76 | 1:75827d765e34 | 453 | CS1 = 1; |
walter76 | 1:75827d765e34 | 454 | } |
walter76 | 1:75827d765e34 | 455 | |
walter76 | 1:75827d765e34 | 456 | return; |
walter76 | 1:75827d765e34 | 457 | } |
walter76 | 1:75827d765e34 | 458 | |
walter76 | 1:75827d765e34 | 459 | |
walter76 | 1:75827d765e34 | 460 | //--------------------------------------------------------------------------- |
walter76 | 1:75827d765e34 | 461 | // Refresh the 2 digits of the gate display |
walter76 | 1:75827d765e34 | 462 | |
walter76 | 1:75827d765e34 | 463 | void Display_2D_write(unsigned short value) |
walter76 | 1:75827d765e34 | 464 | { |
walter76 | 1:75827d765e34 | 465 | |
walter76 | 1:75827d765e34 | 466 | uint8_t digit; |
walter76 | 1:75827d765e34 | 467 | uint16_t mask, data_to_send; |
walter76 | 1:75827d765e34 | 468 | char TextString[2]; |
walter76 | 1:75827d765e34 | 469 | |
walter76 | 1:75827d765e34 | 470 | // int to string, then string to digits |
walter76 | 1:75827d765e34 | 471 | |
walter76 | 1:75827d765e34 | 472 | sprintf(TextString, "%2d", value); // int to string |
walter76 | 1:75827d765e34 | 473 | |
walter76 | 1:75827d765e34 | 474 | if(TextString[0] == ' ') // blank empty digits |
walter76 | 1:75827d765e34 | 475 | Disp_Digit[7] = 0xFF; |
walter76 | 1:75827d765e34 | 476 | else |
walter76 | 1:75827d765e34 | 477 | Disp_Digit[7] = TextString[0] - '0'; |
walter76 | 1:75827d765e34 | 478 | |
walter76 | 1:75827d765e34 | 479 | Disp_Digit[6] = TextString[1] - '0'; |
walter76 | 1:75827d765e34 | 480 | |
walter76 | 1:75827d765e34 | 481 | // write to chip |
walter76 | 1:75827d765e34 | 482 | |
walter76 | 1:75827d765e34 | 483 | SCK = 0; |
walter76 | 1:75827d765e34 | 484 | wait_us(DT); |
walter76 | 1:75827d765e34 | 485 | |
walter76 | 1:75827d765e34 | 486 | for(digit = 7; digit <9; digit++) |
walter76 | 1:75827d765e34 | 487 | { |
walter76 | 1:75827d765e34 | 488 | // each stream consists of digit address and data to show |
walter76 | 1:75827d765e34 | 489 | data_to_send = digit; |
walter76 | 1:75827d765e34 | 490 | data_to_send<<=8; |
walter76 | 1:75827d765e34 | 491 | data_to_send = data_to_send | Disp_Digit[digit-1]; |
walter76 | 1:75827d765e34 | 492 | |
walter76 | 1:75827d765e34 | 493 | CS1 = 0; |
walter76 | 1:75827d765e34 | 494 | |
walter76 | 1:75827d765e34 | 495 | for(mask = 0x8000; mask!= 0; mask>>= 1) |
walter76 | 1:75827d765e34 | 496 | { |
walter76 | 1:75827d765e34 | 497 | wait_us(DT); |
walter76 | 1:75827d765e34 | 498 | SCK = 0; |
walter76 | 1:75827d765e34 | 499 | |
walter76 | 1:75827d765e34 | 500 | if(mask & data_to_send) |
walter76 | 1:75827d765e34 | 501 | MOSI = 1; |
walter76 | 1:75827d765e34 | 502 | else |
walter76 | 1:75827d765e34 | 503 | MOSI = 0; |
walter76 | 1:75827d765e34 | 504 | |
walter76 | 1:75827d765e34 | 505 | wait_us(DT); |
walter76 | 1:75827d765e34 | 506 | SCK = 1; |
walter76 | 1:75827d765e34 | 507 | } |
walter76 | 1:75827d765e34 | 508 | |
walter76 | 1:75827d765e34 | 509 | wait_us(DT); |
walter76 | 1:75827d765e34 | 510 | SCK = 0; |
walter76 | 1:75827d765e34 | 511 | wait_us(DT); |
walter76 | 1:75827d765e34 | 512 | CS1 = 1; |
walter76 | 1:75827d765e34 | 513 | } |
walter76 | 1:75827d765e34 | 514 | |
walter76 | 1:75827d765e34 | 515 | return; |
walter76 | 1:75827d765e34 | 516 | } |
walter76 | 1:75827d765e34 | 517 | |
walter76 | 1:75827d765e34 | 518 | //-------- END OF FILE -------------- |
walter76 | 1:75827d765e34 | 519 | //============================================================================== |
walter76 | 1:75827d765e34 | 520 | |
walter76 | 1:75827d765e34 | 521 | |
walter76 | 1:75827d765e34 | 522 |