Doug Anson / endpoint_core

Core Base Classes for the Light Endpoints

Dependencies:   BufferedSerial

Dependents:   mbed_mqtt_endpoint_ublox_ethernet mbed_mqtt_endpoint_ublox_cellular mbed_nsp_endpoint_ublox_cellular mbed_nsp_endpoint_ublox_ethernet ... more

ErrorHandler.cpp@0:4c9bfcb3e759, 2014-02-24 (annotated)

Committer:
ansond
Date:
Mon Feb 24 19:09:25 2014 +0000
Revision:
0:4c9bfcb3e759
Child:
15:386dccd0000a
initial checkin

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ansond 0:4c9bfcb3e759 1 /* Copyright C2013 Doug Anson, MIT License
ansond 0:4c9bfcb3e759 2 *
ansond 0:4c9bfcb3e759 3 * Permission is hereby granted, free of charge, to any person obtaining a copy of this software
ansond 0:4c9bfcb3e759 4 * and associated documentation files the "Software", to deal in the Software without restriction,
ansond 0:4c9bfcb3e759 5 * including without limitation the rights to use, copy, modify, merge, publish, distribute,
ansond 0:4c9bfcb3e759 6 * sublicense, and/or sell copies of the Software, and to permit persons to whom the Software is
ansond 0:4c9bfcb3e759 7 * furnished to do so, subject to the following conditions:
ansond 0:4c9bfcb3e759 8 *
ansond 0:4c9bfcb3e759 9 * The above copyright notice and this permission notice shall be included in all copies or
ansond 0:4c9bfcb3e759 10 * substantial portions of the Software.
ansond 0:4c9bfcb3e759 11 *
ansond 0:4c9bfcb3e759 12 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING
ansond 0:4c9bfcb3e759 13 * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
ansond 0:4c9bfcb3e759 14 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM,
ansond 0:4c9bfcb3e759 15 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
ansond 0:4c9bfcb3e759 16 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
ansond 0:4c9bfcb3e759 17 */
ansond 0:4c9bfcb3e759 18
ansond 0:4c9bfcb3e759 19 #include "ErrorHandler.h"
ansond 0:4c9bfcb3e759 20
ansond 0:4c9bfcb3e759 21 // Annunciations
ansond 0:4c9bfcb3e759 22 DigitalOut led1(LED1);
ansond 0:4c9bfcb3e759 23 DigitalOut led2(LED2);
ansond 0:4c9bfcb3e759 24 DigitalOut led3(LED3);
ansond 0:4c9bfcb3e759 25 DigitalOut led4(LED4);
ansond 0:4c9bfcb3e759 26
ansond 0:4c9bfcb3e759 27 // Multi-color LED support
ansond 0:4c9bfcb3e759 28 PwmOut r (p23);
ansond 0:4c9bfcb3e759 29 PwmOut g (p24);
ansond 0:4c9bfcb3e759 30 PwmOut b (p25);
ansond 0:4c9bfcb3e759 31
ansond 0:4c9bfcb3e759 32 // close down connections
ansond 0:4c9bfcb3e759 33 extern void closedown();
ansond 0:4c9bfcb3e759 34
ansond 0:4c9bfcb3e759 35 // default constructor
ansond 0:4c9bfcb3e759 36 ErrorHandler::ErrorHandler(MODSERIAL *pc,C12832_LCD *lcd) {
ansond 0:4c9bfcb3e759 37 this->m_pc = pc;
ansond 0:4c9bfcb3e759 38 this->m_lcd = lcd;
ansond 0:4c9bfcb3e759 39 memset(this->m_message,'\0',MAX_LOG_MESSAGE+1);
ansond 0:4c9bfcb3e759 40 this->resetLEDs();
ansond 0:4c9bfcb3e759 41 }
ansond 0:4c9bfcb3e759 42
ansond 0:4c9bfcb3e759 43 // default destructor
ansond 0:4c9bfcb3e759 44 ErrorHandler::~ErrorHandler() {
ansond 0:4c9bfcb3e759 45 }
ansond 0:4c9bfcb3e759 46
ansond 0:4c9bfcb3e759 47 // log information
ansond 0:4c9bfcb3e759 48 void ErrorHandler::log(const char *format, ...) {
ansond 0:4c9bfcb3e759 49 memset(this->m_message,'\0',MAX_LOG_MESSAGE+1);
ansond 0:4c9bfcb3e759 50 va_list args;
ansond 0:4c9bfcb3e759 51 va_start(args, format);
ansond 0:4c9bfcb3e759 52 vsprintf(this->m_message, format, args);
ansond 0:4c9bfcb3e759 53 va_end(args);
ansond 0:4c9bfcb3e759 54 this->m_pc->printf(this->m_message);
ansond 0:4c9bfcb3e759 55 this->m_pc->printf("\r\n");
ansond 0:4c9bfcb3e759 56 this->m_lcd->cls();
ansond 0:4c9bfcb3e759 57 this->m_lcd->locate(0,0);
ansond 0:4c9bfcb3e759 58 this->m_lcd->printf(this->m_message);
ansond 0:4c9bfcb3e759 59 }
ansond 0:4c9bfcb3e759 60
ansond 0:4c9bfcb3e759 61 // check for exit
ansond 0:4c9bfcb3e759 62 void ErrorHandler::checkForExit() {
ansond 0:4c9bfcb3e759 63 if (this->m_pc->readable()) {
ansond 0:4c9bfcb3e759 64 char c = this->m_pc->getc();
ansond 0:4c9bfcb3e759 65 if (c == 0x03) { // CTRL-C ASCII
ansond 0:4c9bfcb3e759 66 this->m_pc->printf("ctrl-c: closing down...\r\n");
ansond 0:4c9bfcb3e759 67 closedown();
ansond 0:4c9bfcb3e759 68 }
ansond 0:4c9bfcb3e759 69 }
ansond 0:4c9bfcb3e759 70 }
ansond 0:4c9bfcb3e759 71
ansond 0:4c9bfcb3e759 72 // set the color LED
ansond 0:4c9bfcb3e759 73 void ErrorHandler::setRGBLED(float H, float S, float V) {
ansond 0:4c9bfcb3e759 74 float f,h,p,q,t;
ansond 0:4c9bfcb3e759 75 int i;
ansond 0:4c9bfcb3e759 76 if( S == 0.0) {
ansond 0:4c9bfcb3e759 77 r = 1.0 - V; // invert pwm !
ansond 0:4c9bfcb3e759 78 g = 1.0 - V;
ansond 0:4c9bfcb3e759 79 b = 1.0 - V;
ansond 0:4c9bfcb3e759 80 return;
ansond 0:4c9bfcb3e759 81 }
ansond 0:4c9bfcb3e759 82 if(H > 360.0) H = 0.0; // check values
ansond 0:4c9bfcb3e759 83 if(S > 1.0) S = 1.0;
ansond 0:4c9bfcb3e759 84 if(S < 0.0) S = 0.0;
ansond 0:4c9bfcb3e759 85 if(V > 1.0) V = 1.0;
ansond 0:4c9bfcb3e759 86 if(V < 0.0) V = 0.0;
ansond 0:4c9bfcb3e759 87 h = H / 60.0;
ansond 0:4c9bfcb3e759 88 i = (int) h;
ansond 0:4c9bfcb3e759 89 f = h - i;
ansond 0:4c9bfcb3e759 90 p = V * (1.0 - S);
ansond 0:4c9bfcb3e759 91 q = V * (1.0 - (S * f));
ansond 0:4c9bfcb3e759 92 t = V * (1.0 - (S * (1.0 - f)));
ansond 0:4c9bfcb3e759 93
ansond 0:4c9bfcb3e759 94 switch(i) {
ansond 0:4c9bfcb3e759 95 case 0:
ansond 0:4c9bfcb3e759 96 r = 1.0 - V; // invert pwm !
ansond 0:4c9bfcb3e759 97 g = 1.0 - t;
ansond 0:4c9bfcb3e759 98 b = 1.0 - p;
ansond 0:4c9bfcb3e759 99 break;
ansond 0:4c9bfcb3e759 100 case 1:
ansond 0:4c9bfcb3e759 101 r = 1.0 - q;
ansond 0:4c9bfcb3e759 102 g = 1.0 - V;
ansond 0:4c9bfcb3e759 103 b = 1.0 - p;
ansond 0:4c9bfcb3e759 104 break;
ansond 0:4c9bfcb3e759 105 case 2:
ansond 0:4c9bfcb3e759 106 r = 1.0 - p;
ansond 0:4c9bfcb3e759 107 g = 1.0 - V;
ansond 0:4c9bfcb3e759 108 b = 1.0 - t;
ansond 0:4c9bfcb3e759 109 break;
ansond 0:4c9bfcb3e759 110 case 3:
ansond 0:4c9bfcb3e759 111 r = 1.0 - p;
ansond 0:4c9bfcb3e759 112 g = 1.0 - q;
ansond 0:4c9bfcb3e759 113 b = 1.0 - V;
ansond 0:4c9bfcb3e759 114 break;
ansond 0:4c9bfcb3e759 115 case 4:
ansond 0:4c9bfcb3e759 116 r = 1.0 - t;
ansond 0:4c9bfcb3e759 117 g = 1.0 - p;
ansond 0:4c9bfcb3e759 118 b = 1.0 - V;
ansond 0:4c9bfcb3e759 119 break;
ansond 0:4c9bfcb3e759 120 case 5:
ansond 0:4c9bfcb3e759 121 default:
ansond 0:4c9bfcb3e759 122 r = 1.0 - V;
ansond 0:4c9bfcb3e759 123 g = 1.0 - p;
ansond 0:4c9bfcb3e759 124 b = 1.0 - q;
ansond 0:4c9bfcb3e759 125 break;
ansond 0:4c9bfcb3e759 126 }
ansond 0:4c9bfcb3e759 127 }
ansond 0:4c9bfcb3e759 128
ansond 0:4c9bfcb3e759 129 // turn the RGB LED specific colors
ansond 0:4c9bfcb3e759 130 void ErrorHandler::turnLEDRed() { this->setRGBLED(0.0,1.0,0.2); }
ansond 0:4c9bfcb3e759 131 void ErrorHandler::turnLEDGreen() { this->setRGBLED(120.0,1.0,0.2); }
ansond 0:4c9bfcb3e759 132 void ErrorHandler::turnLEDBlue() { this->setRGBLED(200.0,1.0,0.2); }
ansond 0:4c9bfcb3e759 133 void ErrorHandler::turnLEDBlack() { this->setRGBLED(0,0,0); }
ansond 0:4c9bfcb3e759 134 void ErrorHandler::turnLEDYellow() { this->setRGBLED(60.0,1.0,0.133); }
ansond 0:4c9bfcb3e759 135
ansond 0:4c9bfcb3e759 136 // reset LEDs
ansond 0:4c9bfcb3e759 137 void ErrorHandler::resetLEDs() {
ansond 0:4c9bfcb3e759 138 // turn off all LEDs
ansond 0:4c9bfcb3e759 139 led1 = 0; led2 = 0; led3 = 0; led4 = 0;
ansond 0:4c9bfcb3e759 140 }
ansond 0:4c9bfcb3e759 141
ansond 0:4c9bfcb3e759 142 // blink an LED
ansond 0:4c9bfcb3e759 143 void ErrorHandler::blinkLED(DigitalOut led) {
ansond 0:4c9bfcb3e759 144 led = 1;
ansond 0:4c9bfcb3e759 145 wait_ms(BLINK_TIME);
ansond 0:4c9bfcb3e759 146 led = 0;
ansond 0:4c9bfcb3e759 147 }
ansond 0:4c9bfcb3e759 148
ansond 0:4c9bfcb3e759 149 // blink the MQTT Transport TX LED
ansond 0:4c9bfcb3e759 150 void ErrorHandler::blinkMQTTTransportTxLED() {
ansond 0:4c9bfcb3e759 151 this->blinkLED(led1);
ansond 0:4c9bfcb3e759 152 }
ansond 0:4c9bfcb3e759 153
ansond 0:4c9bfcb3e759 154 // blink the MQTT Transport RX LED
ansond 0:4c9bfcb3e759 155 void ErrorHandler::blinkMQTTTransportRxLED() {
ansond 0:4c9bfcb3e759 156 this->blinkLED(led2);
ansond 0:4c9bfcb3e759 157 }
ansond 0:4c9bfcb3e759 158
ansond 0:4c9bfcb3e759 159 // blink the HTTP Transport TX LED
ansond 0:4c9bfcb3e759 160 void ErrorHandler::blinkHTTPTransportTxLED() {
ansond 0:4c9bfcb3e759 161 this->blinkLED(led3);
ansond 0:4c9bfcb3e759 162 }
ansond 0:4c9bfcb3e759 163
ansond 0:4c9bfcb3e759 164 // blink the HTTP Transport RX LED
ansond 0:4c9bfcb3e759 165 void ErrorHandler::blinkHTTPTransportRxLED() {
ansond 0:4c9bfcb3e759 166 this->blinkLED(led4);
ansond 0:4c9bfcb3e759 167 }