Бортовой компьютер на ардуино.
- Войдите на сайт для отправки комментариев
Сб, 06/07/2019 - 23:48
Привет всем.Решил собрать себе БК на авто.На форуме джили мк кросс http://www.geely-club.com/forum/topic/7283-samodelnyj-bortovoj-kompyuter/page-1 автор собрал БК с сайта http://code.google.com/p/opengauge/wiki/OBDuino.В общем он сделал без датчиков температуры и напряжения,но есть новая прошивка с датчиками. https://github.com/Magister54/opengauge/blob/master/obduino32K/obduino32K.pde .К каким пинам на ардуино подключить датчики? Прошивка автора без датчиков.
/* OBDuino32K (Requires Atmega328 for your Arduino) Copyright (C) 2008-2010 Main coding/ISO/ELM: Frederic (aka Magister on ecomodder.com) ISO Communication Protocol: Russ, Antony, Mike Features: Mike, Antony, Eimantas Bugs & Fixes: Antony, Fredric, Mike, Eimantas LCD bignum: Frederic based on mpguino code by Dave, Eimantas Latest Changes Jul 11th, 2011 (v197) Buzzer for speed limit (active) Buzzer for coolant temperature (every 1min) Key response fixes Apr 06-12th, 2011 (v193-v195) Summary logging to separate file Single pid and data collection logging (see #define useSDCard section) Log buffering (one access to SD card takes ~170-200ms) Logging to SD card (base) HOWTO in forum page 68 TANK/TRIP/OUTING trip counters Apr 06th, 2011 (v192) Removed not used PID_Desc (saved ~1200bytes) Changed SI and US units selection - if disabled saves ~1300bytes Apr 04th, 2011 (v190) ATTENTION! this update needed additional parameters saving to EEPROM, last tank data will be lost. ISO reinit Driving and idling times for each trip (could be used for average speed and other in future) Max speed PID for each trip (max MAF, RPM, LOAD planned) ISO init first delay changes: 300ms, 600ms, 1200ms, 2400ms, 4800ms, 300ms... BIG pid can be configured do_ISO_Reinit and skip_ISO_Init disabled by default carAlarmScreen disabled by default and allowed to disable it separetly Big font type could be changed without recompiling (~400bytes fonts + ~200bytes config) Mar 29th, 2011 (v189) AutoSave after 30min while driving (disabled by default) Config timeout (10s by default, last changes always accepted) (~100 bytes used) Battery voltage PID for ISO 9141 (was only for ELM) see get_batteryvoltage() for wiring instructions ISO 9141 initialization code trim (128 bytes saved) Gallons and litres conversion changed without functions (234 bytes saved) calcTimeDiff modified according to http://www.arduino.cc/playground/Code/TimingRollover (200 bytes saved) Bug fix in get_icons() smoothed vss was wrongly compared with toggle_speed Mar 10th, 2011 Add smoothing of instant cons Nov 7th, 2010 Added Hybrid Big Num Screen for display AVG in Bigfont, and instant in small font in the corner Oct 28th, 2010 Changes to make BigNum fuctions work more fluently September 14th, 2010: Different currency strings for different currencies. PIDs caching during same calculation cycle. Adjusting tank used fuel and distance. September 6th, 2010: If ISO_Reinit is used added modification to skip startup init. ISO_Reinit is used for first and all other initalizations ISO delay constants (10ms and 55ms) moved to define section. Lower values then allowed in specification works on some cars. LCD bignum August 31st, 2010: ISO 9141 VW MK4 compatible Gasoline/LPG/Diesel support - constant in define section DTC read & clear improvement DTC read enable/disable on start DTC read & clear rebuild tested and working External temperature sensor like KTY81-210 support Saving TRIP data in ISO reinit mode after engine is turned off Turning off backlight in ISO reinit mode if RPM = 0 August 30th, 2010: Some LCD optimizations, formula for MAP, fix check_mil (untested) June 9th, 2009: ISO 9141 re-init, ECU polling, Car alarm and other tweaks by Antony June 24, 2009: Added three parameters to the mix, removed unrequired RPM call, added off and full to backlight levels, added waste PIDs: Antony June 25, 2009: Use the metric parameter for fuel price and tank size: Antony June 27, 2009: Minor corrections and tweaks: Antony July 23, 2009: New menuing system for parameters, and got rid of display flicker: Antony Sept 01, 2009: Better handling of 14230 protocol. Tweak in clear button routine: Antony Sept 27, 2009: Correct four line LCD positioning: Nickdigger (via ecomodder.com) To-Do: Bugs: 1. Fix code to retrieve stored trouble codes. (2010.08.22 fixed in ISO, ELM not tested): 2. Make the Menu response less clunky Features Requested: 1. Aero-Drag calculations? 2. SD Card logging: a) PID time limitations; loging format; analizing software or xls charts; logging pid selection; internal pid logging; real time clock; and other improvements. 3. Add another Fake PID to track max values (Speed, RPM, Tank KM's, etc...) 4. Add a "Score" PID, to rate you for a trip (Quickness, IdleTime, Fuel Used etc as factors) 5. Allow config for L/100 or km/l Other: 1. Trim the Code as we are aproaching the 30.7K limit. a) in config always save params (~200-300 bytes expected) 2. Add a "dirty" flag to tank data when the obduino detects that it has been disconnected from the car to indicate that the data may no longer be complete 3. Config menu optimization (one universal function for all items) This program is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation; either version 2 of the License, or (at your option) any later version. This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. You should have received a copy of the GNU General Public License along with this program; if not, write to the Free Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA */ // Some source about fuel/air ratio mixtures: http://www.apvgn.pt/documentacao/iangv_rep_part2.pdf /**************************/ /* GASOLINE ENGINE CONFIG */ /**************************/ // [CONFIRMED] For gas car use 3355 (1/14.7/730*3600)*10000 #define GasConst 3355 #define GasMafConst 107310 // 14.7*730*10 /************************/ /* LPG ENGINE CONFIG */ /************************/ //LPG mass/volume is 520-580gr/ltr depending on propane/butane mix // LPG/air ratio: // 15.8:1 if 50/50 propane/butate is used // 15:1 if 100 propane is used // 15.4 if 60/40 propane/butane is used // experiments shows that something in middle should be used eg. 15.4:1 :) // [TEST PROGRESS] For lpg(summer >20C) car use 4412 (1/15.4/540*3600)*10000 //#define GasConst 4329 //#define GasMafConst 83160 // 15.4*540*10 = 83160 /************************/ /* DIESEL ENGINE CONFIG */ /************************/ // [NOT TESTED] For diesel car use ??? (1/??/830*3600)*10000 //#define GasConst ???? //#define GasMafConst ??? // ??*830*10 // Compilation modifiers: // The following will cause the compiler to add or remove features from the OBDuino build this keeps the // build size down, will not allow 'on the fly' changes. Some features are dependant on other features. // Comment out to disable big numebers (4th and 5th sceeens) #define use_BIG_font // Comment for normal build // Uncomment for a debug build //#define DEBUG // Comment for normal output build // Uncomment for a debug output build //#define DEBUGOutput // Comment to disable auto-save // Uncoment to enable auto-save after 30min (disabled in debug mode) // EEPROM has limited write cycles 100.000 (probably more) and // saving more often could affect EEPROM, feel free to disable //#define AutoSave // Comment to use MC33290 ISO K line chip // Uncomment to use ELM327 //#define ELM // Comment out to use only the ISO 9141 K line // Uncomment to also use the ISO 9141 L line // This option requires additional wiring to function! // Most newer cars do NOT require this //#define useL_Line // Uncomment only one of the below init sequences if using ISO #define ISO_9141 //#define ISO_14230_fast //#define ISO_14230_slow // Define delay between ISO request bytes (min 5ms, max 20ms) slower is faster refresh rate. By default 10ms. // 5ms gives 8.2pids/s, 10ms gives 6.6pids/s // On some cars 1ms works fine, it will just poll the ECU until it is ready. #define ISORequestByteDelay 5 // Define delay between ISO requests (min 55ms, max 5000ms) slower is faster refresh rate. By default 55ms. // Some cars works with <55ms (faster refresh rate) // ON VW MK4 1ms works fine (but is same as 10ms) // Fasted PID read rate is 19-20pids/s // Discusion about lower values then allowed in ISO9141 specification is in forum page 59-60 // This delay also affects config menu behaviour, because in accu_trip() minimum 3 pids are readed // we get 3x55ms=165ms gap in ACCU_WAIT frame then buttons are inactive. // Need to minimize PID read delay or increase ACCU_WAIT for better config menu response. #define ISORequestDelay 55 // Comment out to just try the PIDs without need to find ECU // Uncomment to use ECU polling to see if car is On or Off #define useECUState // Uncomment to "disconnect" from ECU if RPM is 0 (set ECU state to off) // because VW (maybe others) keeps responding some time after turning car off, // but if engine is restarted - fails // Comment out to disable // DEFAULT: commented #define DisconnectECUIfRPMIsZero // Comment out if ISO 9141 does not need to reinit // Uncomment define below to force reinitialization of ISO 9141 after no ECU communication // this requires ECU polling // DEFAULT: commented #define do_ISO_Reinit // Comment out if ISO 9141 initialization should be done on first startup // Uncomment define below to skip initialization of ISO 9141 after first startup, initialization will be done in ISO_Reinit mode // DEFAULT: commented //#define skip_ISO_Init // Comment out to use the PID screen when the car is off (This will interfere with ISO reinit process) // Uncomment to use the Car Alarm Screen when the car is off // DEFAULT: commented //#define carAlarmScreen // Comment out to disable trip data saving after engine is off and RPM = 0 // Uncomment to save trip data after engine is off and RPM = 0 // DEFAULT: uncommented #define SaveTripDataAfterEngineTurnOff // Comment out to read DTC on OBDuino start. // Uncomment to disable DTC read. // DEFAULT: commented #define DisableDTCReadOnStart // Comment out to do not use temperature sensor // Uncomment to use temperature sensor // DEFAULT: commented //#define UseInsideTemperatureSensor //#define UseOutsideTemperatureSensor //#define TemperatureSensorTypeKTY81_210 // Comment out to do not use voltage sensor // Uncomment to use voltage sensor // DEFAULT: commented //#define BatteryVoltageSensor // Define currency symbols #define CurrencyPrintString "$%s" //#define CurrencyPrintString "%s Lt" #define CurrencyAdjustString "- $%s + " //#define CurrencyAdjustString "- %s Lt +" // Uncomment to use PIDs cache, // it makes faster refresh rate in ISO mode, but uses ~200bytes of memory // DEFAULT: uncommented #define UsePIDCache #ifdef DEBUG #undef do_ISO_Reinit #undef skip_ISO_Init #endif // Uncoment to enable changing metric to US system // If commented - saves 1300bytes in metric, and 600bytes in US // DEFAULT: uncommented #define AllowChangeUnits #ifndef AllowChangeUnits #define UseSI // #define UseUS #endif // Uncoment to use buzzer for speed limits or other notification // Wiring for buzzer with oscilator // 5V ------------- 2N3906 --- (+)Buzzer(-) ---- 0V(GND) // | // 220hm // | // A1 (analog pin) // DEFAULT: commented //#define UseBuzzer #ifdef UseBuzzer #define BuzzerPin 15 // Speed limit 60kmh, will trigger buzzer once on SpeedLimit (60kmh) #define SpeedLimit 60 // bool SpeedLimitReached = false; //UNCOMENT if UseBuzzer // Coolant temperature limit 100C, will trigger buzzer if limit reached (every 1min) #define CoolantTemperatureLimit 100 // unsigned long old_time_system_check; UNCOMENT if UseBuzzer: #endif #undef int #include <stdio.h> #include <limits.h> #include <avr/eeprom.h> #include <avr/pgmspace.h> #include <LiquidCrystal.h> #define LCD_RS 10 #define LCD_ENABLE 9 #define LCD_DATA1 8 #define LCD_DATA2 7 #define LCD_DATA3 6 #define LCD_DATA4 5 // Uncomment to use SD card logging, // need uncomment "#include <FileLogger.h>" too (few lines bellow) and "static char logString[logBufferSize] = {0};" // arduino0022 is messing up with #include and static variables within #ifdef ... #endif //#define useSDCard #ifdef useSDCard // NOTE: some cards must be formated with not Windows, // but http://panasonic.jp/support/global/cs/sd/download/index.html or others. // http://code.google.com/p/arduino-filelogger/ // #include <FileLogger.h> // PIDs and data collections goes to "data.log" //#define logEveryPid #define logDataCollections // Summary goes to "summary.log" (must be created in SD card but space for data log has to be continuous) #define logTripSummary // Choose only one type and at least one // Type logTypeSystem is more compact, uses less memory, // but need some additional application for analizing //#define logTypeVerbose #define logTypeSystem // for faster writing need buffer, bigger is better, but 512 is maximum // if memory ussage is too big - reduce size #define logBufferSize 256 // static char logString[logBufferSize] = {0}; // Need to change LCD data pins 12 and 13 (rewire also) #define LCD_DATA3 2 #define LCD_DATA4 3 // wiring instructions: // http://www.arduino.cc/cgi-bin/yabb2/YaBB.pl?num=1206874649/all // SCK_PIN 13 <-> SD 5 SCK DIVIDER (1.8kOhm, 3.3kOhm) or (2.2kOhm, 3.9kOhm) or similar // MISO_PIN 12 <-> SD 7 DO DIRECT // MOSI_PIN 11 <-> SD 2 DI DIVIDER (1.8kOhm, 3.3kOhm) or (2.2kOhm, 3.9kOhm) or similar // SS_PIN 10 <-> SD 1 CS DIVIDER (1.8kOhm, 3.3kOhm) or (2.2kOhm, 3.9kOhm) or similar // 3.3V <-> SD 4 VCC DIRECT // GND <-> SD 3 GND DIRECT // GND <-> SD 6 GND1 DIRECT #endif // LCD Pins same as mpguino // rs=4, enable=5, data=7,8,12,13 LiquidCrystal lcd(LCD_RS, LCD_ENABLE, LCD_DATA1, LCD_DATA2, LCD_DATA3, LCD_DATA4); #define ContrastPin 11 #define BrightnessPin 3 // LCD prototypes void lcd_print_P(char *string); // to work with string in flash and PSTR() void lcd_cls_print_P(char *string); // clear screen and display string void lcd_char_init(); #ifdef use_BIG_font void lcd_char_bignum(); void bigNum(char *txt, char *txt1); #endif // Memory prototypes void params_load(void); void params_save(void); // Others prototypes byte menu_selection(char ** menu, byte arraySize); byte menu_select_yes_no(byte p); void long_to_dec_str(long value, char *decs, byte prec); int memoryTest(void); void test_buttons(void); void get_cost(char *retbuf, byte ctrip); #define KEY_WAIT 200 // Wait for potential other key press //Was 1000, but 200 works better #define ACCU_WAIT 1000 // Only accumulate data so often. #define BUTTON_DELAY 100 // Not in use any more. Was 125, but 100 works better #define MENU_TIMEOUT 5000 // Wait 10s and close config menu if no key is pressed #ifdef UseOutsideTemperatureSensor #define OutsideTemperaturePin 15 // Inside temperature sensor, on analog 1 #endif #ifdef UseInsideTemperatureSensor #define InsideTemperaturePin 16 // Inside temperature sensor, on analog 2 #endif #ifdef BatteryVoltageSensor #define BatteryVoltagePin 14 // Battery voltage sensor, on analog 0 #endif // use analog pins as digital pins for buttons #define lbuttonPin 17 // Left Button, on analog 3 #define mbuttonPin 18 // Middle Button, on analog 4 #define rbuttonPin 19 // Right Button, on analog 5 #define lbuttonBit 8 // pin17 is a bitmask 8 on port C #define mbuttonBit 16 // pin18 is a bitmask 16 on port C #define rbuttonBit 32 // pin19 is a bitmask 32 on port C #define buttonsUp 0 // start with the buttons in the 'not pressed' state byte buttonState = buttonsUp; // Easy to read macros #define LEFT_BUTTON_PRESSED (buttonState&lbuttonBit) #define MIDDLE_BUTTON_PRESSED (buttonState&mbuttonBit) #define RIGHT_BUTTON_PRESSED (buttonState&rbuttonBit) #define brightnessLength 7 //array size const byte brightness[brightnessLength]={ 0xFF, 0xFF/(brightnessLength+10)*(brightnessLength+10-1), // in night needs more darker 0xFF/brightnessLength*(brightnessLength-1), 0xFF/brightnessLength*(brightnessLength-2), 0xFF/brightnessLength*(brightnessLength-4), 0xFF/brightnessLength*(brightnessLength-5), 0x00}; // right button cycles through these brightness settings (off to on full) byte brightnessIdx=2; /* LCD Display parameters */ /* Adjust LCD_COLS or LCD_ROWS if LCD is different than 16 characters by 2 rows*/ // Note: Not currently tested on display larger than 16x2 // How many rows of characters for the LCD (must be at least two) #define LCD_ROWS 2 // How many characters across for the LCD (must be at least sixteen) #define LCD_COLS 16 // Calculate the middle point of the LCD display width #define LCD_SPLIT (LCD_COLS / 2) //Calculate how many PIDs fit on a data screen (two per line) #define LCD_PID_COUNT (LCD_ROWS * 2) /* PID stuff */ unsigned long pid01to20_support; // this one always initialized at setup() unsigned long pid21to40_support=0; unsigned long pid41to60_support=0; #define PID_SUPPORT00 0x00 #define MIL_CODE 0x01 #define FREEZE_DTC 0x02 #define FUEL_STATUS 0x03 #define LOAD_VALUE 0x04 #define COOLANT_TEMP 0x05 #define STFT_BANK1 0x06 #define LTFT_BANK1 0x07 #define STFT_BANK2 0x08 #define LTFT_BANK2 0x09 #define FUEL_PRESSURE 0x0A #define MAN_PRESSURE 0x0B #define ENGINE_RPM 0x0C #define VEHICLE_SPEED 0x0D #define TIMING_ADV 0x0E #define INT_AIR_TEMP 0x0F #define MAF_AIR_FLOW 0x10 #define THROTTLE_POS 0x11 #define SEC_AIR_STAT 0x12 #define OXY_SENSORS1 0x13 #define B1S1_O2_V 0x14 #define B1S2_O2_V 0x15 #define B1S3_O2_V 0x16 #define B1S4_O2_V 0x17 #define B2S1_O2_V 0x18 #define B2S2_O2_V 0x19 #define B2S3_O2_V 0x1A #define B2S4_O2_V 0x1B #define OBD_STD 0x1C #define OXY_SENSORS2 0x1D #define AUX_INPUT 0x1E #define RUNTIME_START 0x1F #define PID_SUPPORT20 0x20 #define DIST_MIL_ON 0x21 #define FUEL_RAIL_P 0x22 #define FUEL_RAIL_DIESEL 0x23 #define O2S1_WR_V 0x24 #define O2S2_WR_V 0x25 #define O2S3_WR_V 0x26 #define O2S4_WR_V 0x27 #define O2S5_WR_V 0x28 #define O2S6_WR_V 0x29 #define O2S7_WR_V 0x2A #define O2S8_WR_V 0x2B #define EGR 0x2C #define EGR_ERROR 0x2D #define EVAP_PURGE 0x2E #define FUEL_LEVEL 0x2F #define WARM_UPS 0x30 #define DIST_MIL_CLR 0x31 #define EVAP_PRESSURE 0x32 #define BARO_PRESSURE 0x33 #define O2S1_WR_C 0x34 #define O2S2_WR_C 0x35 #define O2S3_WR_C 0x36 #define O2S4_WR_C 0x37 #define O2S5_WR_C 0x38 #define O2S6_WR_C 0x39 #define O2S7_WR_C 0x3A #define O2S8_WR_C 0x3B #define CAT_TEMP_B1S1 0x3C #define CAT_TEMP_B2S1 0x3D #define CAT_TEMP_B1S2 0x3E #define CAT_TEMP_B2S2 0x3F #define PID_SUPPORT40 0x40 #define MONITOR_STAT 0x41 #define CTRL_MOD_V 0x42 #define ABS_LOAD_VAL 0x43 #define CMD_EQUIV_R 0x44 #define REL_THR_POS 0x45 #define AMBIENT_TEMP 0x46 #define ABS_THR_POS_B 0x47 #define ABS_THR_POS_C 0x48 #define ACCEL_PEDAL_D 0x49 #define ACCEL_PEDAL_E 0x4A #define ACCEL_PEDAL_F 0x4B #define CMD_THR_ACTU 0x4C #define TIME_MIL_ON 0x4D #define TIME_MIL_CLR 0x4E // // #define FUEL_TYPE 0x51 #define ETHYL_FUEL 0x52 #define LAST_PID 0x52 // same as the last one defined above /* our internal fake PIDs */ #define FIRST_FAKE_PID 0xDE // same as the first one defined below #define OUTING_MAX_VSS 0xDE #define TRIP_MAX_VSS 0xDF #define TANK_MAX_VSS 0xE0 #define OUTING_IDLE_TIME 0xE1 #define TRIP_IDLE_TIME 0xE2 #define TANK_IDLE_TIME 0xE3 #define OUTING_DRIVE_TIME 0xE4 #define TRIP_DRIVE_TIME 0xE5 #define TANK_DRIVE_TIME 0xE6 #define OUTSIDE_TEMP 0xE7 // temperature outside the car #define INSIDE_TEMP 0xE8 // temperature inside the car #define OUTING_WASTE 0xE9 // fuel wasted since car started #define TRIP_WASTE 0xEA // fuel wasted during trip #define TANK_WASTE 0xEB // fuel wasted for this tank #define OUTING_COST 0xEC // the money spent since car started #define TRIP_COST 0xED // money spent since on trip #define TANK_COST 0xEE // money spent of current tank #define ENGINE_ON 0xEF // The length of time car has been running. #define NO_DISPLAY 0xF0 #define FUEL_CONS 0xF1 // instant cons #define TANK_CONS 0xF2 // average cons of tank #define TANK_FUEL 0xF3 // fuel used in tank #define TANK_DIST 0xF4 // distance for tank #define REMAIN_DIST 0xF5 // remaining distance of tank #define TRIP_CONS 0xF6 // average cons of trip #define TRIP_FUEL 0xF7 // fuel used in trip #define TRIP_DIST 0xF8 // distance of trip #define BATT_VOLTAGE 0xF9 #define OUTING_CONS 0xFA // cons since the engine turned on #define OUTING_FUEL 0xFB // fuel used since engine turned on #define OUTING_DIST 0xFC // distance since engine turned on #define CAN_STATUS 0xFD #define PID_SEC 0xFE #ifdef DEBUG //why waste a valueable PID space!! #define FREE_MEM 0xFF #else #define ECO_VISUAL 0xFF // Visually dispay relative economy with text (at end of program) #endif //The Textual Description of each PID prog_char PID_Desc[(1+LAST_PID)+(0xFF-FIRST_FAKE_PID)+1][9] PROGMEM= { "PID00-21", // 0x00 PIDs supported "Stat DTC", // 0x01 Monitor status since DTCs cleared. "Frz DTC", // 0x02 Freeze DTC "Fuel SS", // 0x03 Fuel system status "Eng Load", // 0x04 Calculated engine load value "CoolantT", // 0x05 Engine coolant temperature "ST F%T 1", // 0x06 Short term fuel % trim Bank 1 "LT F%T 1", // 0x07 Long term fuel % trim Bank 1 "ST F%T 2", // 0x08 Short term fuel % trim Bank 2 "LT F%T 2", // 0x09 Long term fuel % trim Bank 2 "Fuel Prs", // 0x0A Fuel pressure " MAP ", // 0x0B Intake manifold absolute pressure " RPM ", // 0x0C Engine RPM " Speed ", // 0x0D Vehicle speed "Timing A", // 0x0E Timing advance "Intake T", // 0x0F Intake air temperature "MAF rate", // 0x10 MAF air flow rate "Throttle", // 0x11 Throttle position "Cmd SAS", // 0x12 Commanded secondary air status "Oxy Sens", // 0x13 Oxygen sensors present "Oxy B1S1", // 0x14 Oxygen Sensor Bank 1, Sensor 1 "Oxy B1S2", // 0x15 Oxygen Sensor Bank 1, Sensor 2 "Oxy B1S3", // 0x16 Oxygen Sensor Bank 1, Sensor 3 "Oxy B1S4", // 0x17 Oxygen Sensor Bank 1, Sensor 4 "Oxy B2S1", // 0x18 Oxygen Sensor Bank 2, Sensor 1 "Oxy B2S2", // 0x19 Oxygen Sensor Bank 2, Sensor 2 "Oxy B2S3", // 0x1A Oxygen Sensor Bank 2, Sensor 3 "Oxy B2S4", // 0x1B Oxygen Sensor Bank 2, Sensor 4 "OBD Std", // 0x1C OBD standards this vehicle conforms to "Oxy Sens", // 0x1D Oxygen sensors present "AuxInpt", // 0x1E Auxiliary input status "Run Time", // 0x1F Run time since engine start "PID21-40", // 0x20 PIDs supported 21-40 "Dist MIL", // 0x21 Distance traveled with malfunction indicator lamp (MIL) on "FRP RMF", // 0x22 Fuel Rail Pressure (relative to manifold vacuum) "FRP Dies", // 0x23 Fuel Rail Pressure (diesel) "OxyS1 V", // 0x24 O2S1_WR_lambda(1): ER Voltage "OxyS2 V", // 0x25 O2S2_WR_lambda(1): ER Voltage "OxyS3 V", // 0x26 O2S3_WR_lambda(1): ER Voltage "OxyS4 V", // 0x27 O2S4_WR_lambda(1): ER Voltage "OxyS5 V", // 0x28 O2S5_WR_lambda(1): ER Voltage "OxyS6 V", // 0x29 O2S6_WR_lambda(1): ER Voltage "OxyS7 V", // 0x2A O2S7_WR_lambda(1): ER Voltage "OxyS8 V", // 0x2B O2S8_WR_lambda(1): ER Voltage "Cmd EGR", // 0x2C Commanded EGR "EGR Err", // 0x2D EGR Error "Cmd EP", // 0x2E Commanded evaporative purge "Fuel LI", // 0x2F Fuel Level Input "WarmupCC", // 0x30 # of warm-ups since codes cleared "Dist CC", // 0x31 Distance traveled since codes cleared "Evap SVP", // 0x32 Evap. System Vapor Pressure "Barometr", // 0x33 Barometric pressure "OxyS1 C", // 0x34 O2S1_WR_lambda(1): ER Current "OxyS2 C", // 0x35 O2S2_WR_lambda(1): ER Current "OxyS3 C", // 0x36 O2S3_WR_lambda(1): ER Current "OxyS4 C", // 0x37 O2S4_WR_lambda(1): ER Current "OxyS5 C", // 0x38 O2S5_WR_lambda(1): ER Current "OxyS6 C", // 0x39 O2S6_WR_lambda(1): ER Current "OxyS7 C", // 0x3A O2S7_WR_lambda(1): ER Current "OxyS8 C", // 0x3B O2S8_WR_lambda(1): ER Current "C T B1S1", // 0x3C Catalyst Temperature Bank 1 Sensor 1 "C T B1S2", // 0x3D Catalyst Temperature Bank 1 Sensor 2 "C T B2S1", // 0x3E Catalyst Temperature Bank 2 Sensor 1 "C T B2S2", // 0x3F Catalyst Temperature Bank 2 Sensor 2 "PID41-60", // 0x40 PIDs supported 41-60 " MStDC", // 0x41 Monitor status this drive cycle "Ctrl M V", // 0x42 Control module voltage "Abs L V", // 0x43 Absolute load value "Cmd E R", // 0x44 Command equivalence ratio "R ThrotP", // 0x45 Relative throttle position "Amb Temp", // 0x46 Ambient air temperature "Acc PP B", // 0x47 Absolute throttle position B "Acc PP C", // 0x48 Absolute throttle position C "Acc PP D", // 0x49 Accelerator pedal position D "Acc PP E", // 0x4A Accelerator pedal position E "Acc PP F", // 0x4B Accelerator pedal position F "Cmd T A", // 0x4C Commanded throttle actuator "T MIL On", // 0x4D Time run with MIL on "T TC Crl", // 0x4E Time since trouble codes cleared " 0x4F", // 0x4F Unknown " 0x50", // 0x50 Unknown "Fuel Typ", // 0x51 Fuel Type "Ethyl F%", // 0x52 Ethanol fuel % "Out MVSS", // 0xDE "Trp MVSS", // 0xDF "Tnk MVSS", // 0xE0 "Out Idle", // 0xE1 "Trp Idle", // 0xE2 "Tnk Idle", // 0xE3 "OutDrive", // 0xE4 "TrpDrive", // 0xE5 "TnkDrive", // 0xE6 "OutsideT", // 0xE7 temperature outside car "Inside T", // 0xE8 temperature inside car "OutWaste", // 0xE9 outing waste "TrpWaste", // 0xEA trip waste "TnkWaste", // 0xEB tank waste "Out Cost", // 0xEC outing cost "Trp Cost", // 0xED trip cost "Tnk Cost", // 0xEE tank cost "Out Time", // 0xEF The length of time car has been running "No Disp", // 0xF0 No display "InstCons", // 0xF1 instant cons "Tnk Cons", // 0xF2 average cons of tank "Tnk Fuel", // 0xF3 fuel used in tank "Tnk Dist", // 0xF4 distance for tank "Dist2MT", // 0xF5 remaining distance of tank "Trp Cons", // 0xF6 average cons of trip "Trp Fuel", // 0xF7 fuel used in trip "Trp Dist", // 0xF8 distance of trip "Batt Vlt", // 0xF9 Battery Voltage "Out Cons", // 0xFA cons since the engine turned on "Out Fuel", // 0xFB fuel used since engine turned on "Out Dist", // 0xFC distance since engine turned on "Can Stat", // 0xFD Can Status "PID_SEC", // 0xFE "Eco Vis" // 0xFF Visually dispay relative economy with text }; const prog_char obd_std_strings[17][9] PROGMEM = { /*00*/ /*{ "" },*/ { "OBD2CARB" }, { "OBDEPA" }, { "OBDEPA&2" }, /*04*/ { "OBD1" }, { "NO OBD" }, { "EOBD" }, { "EOBD&2" }, /*08*/ { "EOBD&EPA" }, { "E&EPA&2" }, { "JOBD" }, { "JOBD&2" }, /*0C*/ { "J&EOBD" }, { "J&EOBD&2" }, { "EURO4B1" }, { "EURO5B2" }, /*10*/ { "EURO C" }, { "EMD" } }; // returned length of the PID response. // constants so put in flash prog_uchar pid_reslen[] PROGMEM= { // pid 0x00 to 0x1F 4,4,2,2,1,1,1,1,1,1,1,1,2,1,1,1, 2,1,1,1,2,2,2,2,2,2,2,2,1,1,1,4, // pid 0x20 to 0x3F 4,2,2,2,4,4,4,4,4,4,4,4,1,1,1,1, 1,2,2,1,4,4,4,4,4,4,4,4,2,2,2,2, // pid 0x40 to 0x4E 4,8,2,2,2,1,1,1,1,1,1,1,1,2,2 }; // Number of screens of PIDs #define NBSCREEN 3 // 12 PIDs should be enough for everyone #ifdef use_BIG_font #define BIG_NBSCREEN 2 #else #define BIG_NBSCREEN 2 #endif byte active_screen=0; // 0,1,2,... selected by left button prog_char pctd[] PROGMEM="- %d + "; // used in a couple of place prog_char pctdpctpct[] PROGMEM="- %d%% + "; // used in a couple of place prog_char pctspcts[] PROGMEM="%s %s"; // used in a couple of place prog_char pctldpcts[] PROGMEM="%ld %s"; // used in a couple of place prog_char select_no[] PROGMEM="(NO) YES "; // for config menu prog_char select_yes[] PROGMEM=" NO (YES)"; // for config menu prog_char gasPrice[][10] PROGMEM={"- %s\354 + ", CurrencyAdjustString}; // dual string for fuel price prog_char noDTCcodes[] PROGMEM="No DTC codes"; // for MIL // menu items used by menu_selection. prog_char *topMenu[] PROGMEM = {"Configure menu", "Exit", "Display", "Adjust", "PIDs", "Clear DTC"}; prog_char *displayMenu[] PROGMEM = {"Display menu", "Exit", "Contrast", "Metric", "Fuel/Hour", "Font"}; prog_char *adjustMenu[] PROGMEM = {"Adjust menu", "Exit", "Tank Size", "Fuel Cost", "Fuel %", "Speed %", "Out Wait", "Trip Wait", "Tank Used", "Tank Dist", "Eng Disp", }; prog_char *PIDMenu[] PROGMEM = {"PID Screen menu", "Exit", "Scr 1", "Scr 2", "Scr 3", "Big 1", "Big 2"}; #define ARRAY_SIZE(x) (sizeof(x) / sizeof(*(x))) // Time information #define MILLIS_PER_HOUR 3600000L #define MILLIS_PER_MINUTE 60000L #define MILLIS_PER_SECOND 1000L // to differenciate trips #define TANK 0 #define TRIP 1 #define OUTING 2 //Tracks your current outing #define NBTRIP 3 prog_char * tripNames[NBTRIP] PROGMEM = { "Tank", "Trip", "Outing" }; // parameters // each trip contains fuel used and distance done typedef struct { unsigned long dist; // in cm unsigned long fuel; // in uL unsigned long waste; // in uL } trip_t; // saving trip max data and time typedef struct { unsigned char maxspeed; // in km/h unsigned int maxrpm; // in rpm unsigned char maxmaf; // in g unsigned char counter; // in # unsigned long timedriving; // in ms unsigned long timeidling; // in ms } trip_max; // each screen contains n PIDs (two per line) typedef struct { byte PID[LCD_PID_COUNT]; } screen_t; #define MINUTES_GRANULARITY 10 typedef struct { byte contrast; // we only use 0-100 value in step 20 byte use_metric; // 0=rods and hogshead, 1=SI boolean use_comma; // When using metric, also use the comma decimal separator byte per_hour_speed; // speed from which we toggle to fuel/hour (km/h or mph) byte fuel_adjust; // because of variation from car to car, temperature, etc byte speed_adjust; // because of variation from car to car, tire size, etc byte eng_dis; // engine displacement in dL unsigned int gas_price; // price per unit of fuel in 10th of cents. 905 = $0.905 unsigned int tank_size; // tank size in dL or dgal depending of unit byte OutingStopOver; // Allowable stop over time (in tens of minutes). Exceeding time starts a new outing. byte TripStopOver; // Allowable stop over time (in hours). Exceeding time starts a new outing. trip_t trip[NBTRIP]; // trip0=tank, trip1=a trip, trip2=outing trip_max tripmax[NBTRIP]; // trip0=tank, trip1=a trip, trip2=outing screen_t screen[NBSCREEN + BIG_NBSCREEN]; // screen byte BigFontType; // Posible values: 0 - 2x2_alpha; 1 - 2x2_beta; 2 - 2x3. byte MetricDisplayType; // Possible values: 0 - l/100km; 1 - km/l. //reserved place for future development } params_t; // parameters default values params_t params= { 40, // 40 does not work with some LCD, or some misterious problem so try 0 if it does not work 1, true, 20, 100, 100, 15, 1090, 450, 6, // 60 minutes (6 X 10) stop or less will not cause outing reset 12, // 12 hour stop or less will not cause trip reset { { 0,0,0 }, // tank: dist, fuel, waste { 0,0,0 }, // trip: dist, fuel, waste { 0,0,0 } // outing:dist, fuel, waste }, { { 0,0,0,0, 0,0 }, // tank: speed,rpm,maf; trip count; time driving, time idling { 0,0,0,0, 0,0 }, // trip: speed,rpm,maf; trip count; time driving, time idling { 0,0,0,0, 0,0 } // outing:speed,rpm,maf; trip count; time driving, time idling }, { { {FUEL_CONS,LOAD_VALUE,TANK_CONS,OUTING_FUEL #if LCD_ROWS == 4 ,OUTING_WASTE,OUTING_COST,ENGINE_ON,LOAD_VALUE #endif } }, { {TRIP_CONS,TRIP_DIST,TRIP_FUEL,COOLANT_TEMP #if LCD_ROWS == 4 ,TRIP_WASTE,TRIP_COST,INT_AIR_TEMP,THROTTLE_POS #endif } }, { {TANK_CONS,TANK_DIST,TANK_FUEL,REMAIN_DIST #if LCD_ROWS == 4 ,TANK_WASTE,TANK_COST,ENGINE_RPM,VEHICLE_SPEED #endif } }, { {FUEL_CONS,NO_DISPLAY,NO_DISPLAY,NO_DISPLAY #if LCD_ROWS == 4 ,NO_DISPLAY,NO_DISPLAY,NO_DISPLAY,NO_DISPLAY #endif } }, { {ENGINE_RPM,FUEL_CONS,NO_DISPLAY,NO_DISPLAY #if LCD_ROWS == 4 ,NO_DISPLAY,NO_DISPLAY,NO_DISPLAY,NO_DISPLAY #endif } } }, 0, //BigFontType 0 //MetricDisplayType }; prog_char *econ_Visual[] PROGMEM= { "Yuck!!8{", "Aweful:(", "Poor :[", "OK :|", "Good :]", "Great :)", "Adroit:D", "HyprM 8D" }; #define STRLEN 40 #ifdef ELM #define NUL '\0' #define CR '\r' // carriage return = 0x0d = 13 #define PROMPT '>' #define DATA 1 // data with no cr/prompt #else /* * for ISO9141-2 Protocol */ #define K_IN 0 #define K_OUT 1 #ifdef useL_Line #define L_OUT 2 #endif #endif long tempLong; // Useful for transitory values while getting PID information. // some globals, for trip calculation and others unsigned long old_time; byte has_rpm=0; long vss=0; // speed long maf=0; // MAF long engineRPM=0; // RPM unsigned long engine_on, engine_off; //used to track time of trip. #ifdef AutoSave unsigned long old_time_params; #endif #ifdef UsePIDCache // Cache PID's value #define MaxPIDCacheCount 5 typedef struct { byte PID; long Value; unsigned long Time; char String[STRLEN]; } TPIDCache; TPIDCache PIDCache[MaxPIDCacheCount]; //prog_char PIDCacheString[MaxPIDCacheCount][STRLEN] PROGMEM={"","","","",""}; // Must be initialized byte PIDCacheCount=0; #endif unsigned long getpid_time; byte nbpid_per_second=0; // flag used to save distance/average consumption in eeprom only if required byte engine_started=0; byte param_saved=0; #ifdef ELM #if defined do_ISO_Reinit #error do_ISO_Reinit is ONLY ISO 9141 It is not to be used with ELM! #endif #if defined skip_ISO_Init #error skip_ISO_Init is ONLY ISO 9141 It is not to be used with ELM! #endif #endif #ifndef useECUState #if defined do_ISO_Reinit #error do_ISO_Reinit must have useECUState also defined #endif #endif #ifndef do_ISO_Reinit #if defined skip_ISO_Init #error skip_ISO_Init must have do_ISO_Reinit also defined #endif #endif #if defined (DEBUG) && defined (do_ISO_Reinit) #error Error: could not be defined DEBUG and do_ISO_Reinit at same time #endif #if defined (DEBUG) && defined (skip_ISO_Init) #error Error: could not be defined DEBUG and skip_ISO_Init at same time #endif /* // This check is not needed anymore #ifdef do_ISO_Reinit #ifndef carAlarmScreen #error ISO reinit will not function when not displaying the car alarm screen (#define carAlarmScreen) #endif #endif */ #ifdef DEBUG #ifdef AutoSave #error AutoSave could not be enabled in DEBUG mode (it will save crappy data) #endif #endif #ifdef useECUState boolean oldECUconnection; // Used to test for change in ECU connection state #endif #ifdef carAlarmScreen boolean refreshAlarmScreen; // Used to cause non-repeating screen data to display #endif #ifndef ELM // ISO 9141 communication variables byte ISO_InitStep = 0; // Init is multistage, this is the counter boolean ECUconnection; // Have we connected to the ECU or not unsigned long lastReceivedPIDTime = 0; #ifdef DEBUGOutput // debug information for ISO9141 init debuging byte LastISO_InitStep = 0; // Init is multistage, this is last stage memory byte LastReceived1 = 0; byte LastReceived2 = 0; byte LastReceived3 = 0; byte LastReceived1OK = 0; byte LastReceived2OK = 0; byte LastReceived3OK = 0; byte LastSend1 = 0; #endif #endif // the buttons interrupt // this is the interrupt handler for button presses ISR(PCINT1_vect) { #if 0 // it is wrong to access timers in ISR, // this code bellow in "#if 0" has to be removed static unsigned long last_millis = 0; unsigned long m = millis(); if ((long)(m - last_millis) > 20) { // do pushbutton stuff buttonState |= ~PINC; } // else ignore interrupt: probably a bounce problem last_millis = m; #else buttonState |= ~PINC; #endif } #ifdef ELM /* each ELM response ends with '\r' followed at the end by the prompt so read com port until we find a prompt */ byte elm_read(char *str, byte size) { int b; byte i=0; // wait for something on com port while((b=Serial.read())!=PROMPT && i<size) { if(/*b!=-1 &&*/ b>=' ') str[i++]=b; } if(i!=size) // we got a prompt { str[i]=NUL; // replace CR by NUL return PROMPT; } else return DATA; } // buf must be ASCIIZ void elm_write(char *str) { while(*str!=NUL) Serial.write(*str++); } // check header byte byte elm_check_response(const char *cmd, char *str) { // cmd is something like "010D" // str should be "41 0D blabla" if(cmd[0]+4 != str[0] || cmd[1]!=str[1] || cmd[2]!=str[3] || cmd[3]!=str[4]) return 1; return 0; // no error } byte elm_compact_response(byte *buf, char *str) { byte i=0; // start at 6 which is the first hex byte after header // ex: "41 0C 1A F8" // return buf: 0x1AF8 str+=6; while(*str!=NUL) buf[i++]=strtoul(str, &str, 16); // 16 = hex return i; } // write simple string to ELM and return read result // cmd is a PSTR !! byte elm_command(char *str, char *cmd) { strcpy_P(str, cmd); elm_write(str); return elm_read(str, STRLEN); } void elm_init() { char str[STRLEN]; Serial.begin(9600); Serial.flush(); #ifndef DEBUG // reset, wait for something and display it elm_command(str, PSTR("ATWS\r")); lcd.setCursor(0,1); if(str[0]=='A') // we have read back the ATWS lcd.print(str+4); else lcd.print(str); lcd_print_P(PSTR(" Init")); // turn echo off elm_command(str, PSTR("ATE0\r")); // send 01 00 until we are connected do { elm_command(str, PSTR("0100\r")); delay(1000); } while(elm_check_response("0100", str)!=0); // ask protocol elm_command(str, PSTR("ATDPN\r")); // str[0] should be 'A' for automatic // set header to talk directly to ECU#1 if(str[1]=='1') // PWM elm_command(str, PSTR("ATSHE410F1\r")); else if(str[1]=='2') // VPW elm_command(str, PSTR("ATSHA810F1\r")); else if(str[1]=='3') // ISO 9141 elm_command(str, PSTR("ATSH6810F1\r")); else if(str[1]=='6') // CAN 11 bits elm_command(str, PSTR("ATSH7E0\r")); else if(str[1]=='7') // CAN 29 bits elm_command(str, PSTR("ATSHDA10F1\r")); #endif } #else void serial_rx_on() { // UCSR0B |= _BV(RXEN0); //enable UART RX Serial.begin(10400); //setting enable bit didn't work, so do beginSerial } void serial_rx_off() { UCSR0B &= ~(_BV(RXEN0)); //disable UART RX } void serial_tx_off() { UCSR0B &= ~(_BV(TXEN0)); //disable UART TX delay(20); //allow time for buffers to flush } #ifdef DEBUG #define READ_ATTEMPTS 2 #else #define READ_ATTEMPTS 125 #endif // User must pass in a pointer to a byte to recieve the data. // Return value reflects success of the read attempt. boolean iso_read_byte(byte * b) { int readData; boolean success = true; byte t=0; while(t != READ_ATTEMPTS && (readData=Serial.read())==-1) { delay(1); t++; } if (t >= READ_ATTEMPTS) { success = false; } if (success) { *b = (byte) readData; } return success; } void iso_write_byte(byte b) { serial_rx_off(); Serial.print(b); delay(ISORequestByteDelay); // ISO requires 5-20 ms delay between bytes. serial_rx_on(); } // inspired by SternOBDII\code\checksum.c byte iso_checksum(byte *data, byte len) { byte crc=0; for(byte i=0; i<len; i++) crc=crc+data[i]; return crc; } // inspired by SternOBDII\code\iso.c void iso_write_data(byte *data, byte len) { byte i, n; byte buf[20]; #ifdef ISO_9141 // ISO header buf[0]=0x68; buf[1]=0x6A; // 0x68 0x6A is an OBD-II request buf[2]=0xF1; // our requesters address (off-board tool) #else // 14230 protocol header buf[0]=0xc2; // Request of 2 bytes buf[1]=0x33; // Target address buf[2]=0xF1; // our requesters address (off-board tool) #endif // append message for(i=0; i<len; i++) buf[i+3]=data[i]; // calculate checksum i+=3; buf[i]=iso_checksum(buf, i); // send char one by one n=i;//+1; for(i=0; i<=n; i++) iso_write_byte(buf[i]); // CodeOptimization (2bytes) // function changed to 'void' (was byte, but not used, always returned 0) // return 0; } // read n byte(s) of data (+ header + cmd and crc) // return the count of bytes of message (includes all data in message) byte iso_read_data(byte *data, byte len) { byte i, c; byte buf[20]; byte dataSize = 0; // header 3 bytes: [80+datalen] [destination=f1] [source=01] // data 1+1+len bytes: [40+cmd0] [cmd1] [result0] // checksum 1 bytes: [sum(header)+sum(data)] // a total of six extra bytes of data c = len+6; for(i=0; i<c; i++) { if (iso_read_byte(buf+i)) { dataSize++; } } // test, skip header comparison // ignore failure for the moment (0x7f) // ignore crc for the moment // we send only one command, so result start at buf[4] Actually, result starts at buf[5], buf[4] is pid requested... memcpy(data, buf+5, len); lastReceivedPIDTime = millis(); return dataSize - 6; // return payload length } /* ISO 9141 init */ // The init process is done in timed sections now so that during the reinit process // the user can use the buttons, and the screen can be updated. // Note: Due to the timed nature of this init process, if the display screen takes up too much CPU time, this will not succeed void iso_init() { long currentTime = millis(); static long initTime; static int initFirstDelay = 300; #ifdef ISO_9141 // CodeOptimization (128bytes) // Changed ISO init 2-7 steps to take values from array (could be moved to PROGMEM) // ISO_14230_slow could be changed too (same way) byte ISOSteps[8] = { 0, //0 not used 30, //1 HIGH 20, //2 LOW 40, //3 HIGH 40, //4 LOW 40, //5 HIGH 40, //6 LOW 26 //7 HIGH }; if (ISO_InitStep == 0) { // setup ECUconnection = false; serial_tx_off(); //disable UART so we can "bit-Bang" the slow init. serial_rx_off(); initTime = currentTime + initFirstDelay; initFirstDelay = (initFirstDelay % 4500) * 2; //if 4800 then down to 300ms AND sequence: 300, 600, 1200, 2400, 4800 ISO_InitStep++; } else if (currentTime >= initTime) { if (ISO_InitStep > 0 && ISO_InitStep < 8) { digitalWrite(K_OUT, ISO_InitStep % 2); #ifdef useL_Line digitalWrite(L_OUT, ISO_InitStep % 2); #endif initTime = currentTime + ISOSteps[ISO_InitStep] * 10; ISO_InitStep++; } else if (ISO_InitStep == 8) { #ifdef useL_Line digitalWrite(L_OUT, LOW); #endif // bit banging done, now verify connection at 10400 baud byte b = 0; // switch now to 10400 bauds Serial.begin(10400); // wait for 0x55 from the ECU (up to 300ms) //since our time out for reading is 125ms, we will try it up to three times for (byte i=0; i<3; i++) if (iso_read_byte(&b)) break; if(b == 0x55) { ISO_InitStep++; } else { // oops unexpected data, try again ISO_InitStep = 0; } } else // ISO_InitStep == 9 { byte b; bool bread; bread = iso_read_byte(&b); // read kw1 #ifdef DEBUGOutput LastReceived1 = b; LastReceived1OK = bread ? 1 : 0; #endif bread = iso_read_byte(&b); // read kw2 #ifdef DEBUGOutput LastReceived2 = b; LastReceived2OK = bread ? 1 : 0; #endif // 25ms delay needed before reply (url with spec is on forum page 56) // it does not work without it on VW MK4 delay(25); // send ~kw2 (invert of last keyword) iso_write_byte(~b); #ifdef DEBUGOutput LastSend1 = ~b; #endif // ECU answer by 0xCC (~0x33) // read several times, ECU not always responds in time for (byte i=0; i<3; i++) { bread = iso_read_byte(&b); if (bread) break; } #ifdef DEBUGOutput LastReceived3 = b; LastReceived3OK = bread ? 1 : 0; #endif if (b == 0xCC) { ECUconnection = true; // update for correct delta time in trip calculations. old_time = millis(); } ISO_InitStep = 0; } } #elif defined ISO_14230_fast switch (ISO_InitStep) { case 0: // setup ECUconnection = false; serial_tx_off(); //disable UART so we can "bit-Bang" the slow init. serial_rx_off(); initTime = currentTime + initFirstDelay; initFirstDelay = (initFirstDelay % 4500) * 2; //if 4800 then down to 300ms AND sequence: 300, 600, 1200, 2400, 4800 ISO_InitStep++; break; case 1: if (currentTime >= initTime) { // drive K line high for 300ms digitalWrite(K_OUT, HIGH); #ifdef useL_Line digitalWrite(L_OUT, HIGH); #endif initTime = currentTime + 300; ISO_InitStep++; } break; case 2: case 3: if (currentTime >= initTime) { // start or stop bit digitalWrite(K_OUT, (ISO_InitStep == 2 ? LOW : HIGH)); #ifdef useL_Line digitalWrite(L_OUT, (ISO_InitStep == 2 ? LOW : HIGH)); #endif initTime = currentTime + (ISO_InitStep == 2 ? 25 : 25); ISO_InitStep++; } break; case 4: if (currentTime >= initTime) { // bit banging done, now verify connection at 10400 baud byte dataStream[] = {0xc1, 0x33, 0xf1, 0x81, 0x66}; byte dataStreamSize = ARRAY_SIZE(dataStream); boolean gotData = false; const byte dataResponseSize = 10; byte dataResponse[dataResponseSize]; byte responseIndex = 0; byte dataCaught = '\0'; // switch now to 10400 bauds Serial.begin(10400); // Send the message for (byte i = 0; i < dataStreamSize; i++) { iso_write_byte(dataStream[i]); } // Wait for response for 300 ms initTime = currentTime + 300; do { // If we find any data, keep catching it until it ends while(iso_read_byte(&dataCaught)) { gotData = true; dataResponse[responseIndex] = dataCaught; responseIndex++; } } while (millis() <= initTime && !gotData); if (gotData) // or better yet validate the data... { ECUconnection = true; // update for correct delta time in trip calculations. old_time = millis(); // Note: we do not actually validate this connection. It would be best to validate the connection. // Can someone validate this with a car that actually uses this connection? } ISO_InitStep = 0; } break; } #elif defined ISO_14230_slow switch (ISO_InitStep) { case 0: // setup ECUconnection = false; serial_tx_off(); //disable UART so we can "bit-Bang" the slow init. serial_rx_off(); initTime = currentTime + initFirstDelay; initFirstDelay = (initFirstDelay % 4500) * 2; //if 4800 then down to 300ms AND sequence: 300, 600, 1200, 2400, 4800 ISO_InitStep++; break; case 1: if (currentTime >= initTime) { // drive K line high for 300ms digitalWrite(K_OUT, HIGH); #ifdef useL_Line digitalWrite(L_OUT, HIGH); #endif initTime = currentTime + 300; ISO_InitStep++; } break; case 2: case 7: if (currentTime >= initTime) { // start or stop bit digitalWrite(K_OUT, (ISO_InitStep == 2 ? LOW : HIGH)); #ifdef useL_Line digitalWrite(L_OUT, (ISO_InitStep == 2 ? LOW : HIGH)); #endif initTime = currentTime + (ISO_InitStep == 2 ? 200 : 260); ISO_InitStep++; } break; case 3: case 5: if (currentTime >= initTime) { // two bits HIGH digitalWrite(K_OUT, HIGH); #ifdef useL_Line digitalWrite(L_OUT, HIGH); #endif initTime = currentTime + 400; ISO_InitStep++; } break; case 4: case 6: if (currentTime >= initTime) { // two bits LOW digitalWrite(K_OUT, LOW); #ifdef useL_Line digitalWrite(L_OUT, LOW); // Note: after this do we drive the L line back up high, or just leave it alone??? #endif initTime = currentTime + 400; ISO_InitStep++; } break; case 8: if (currentTime >= initTime) { // bit banging done, now verify connection at 10400 baud byte dataStream[] = {0xc1, 0x33, 0xf1, 0x81, 0x66}; byte dataStreamSize = ARRAY_SIZE(dataStream); boolean gotData = false; const byte dataResponseSize = 10; byte dataResponse[dataResponseSize]; byte responseIndex = 0; byte dataCaught = '\0'; // switch now to 10400 bauds Serial.begin(10400); // Send the message for (byte i = 0; i < dataStreamSize; i++) { iso_write_byte(dataStream[i]); } // Wait for response for 300 ms initTime = currentTime + 300; do { // If we find any data, keep catching it until it ends while (iso_read_byte(&dataCaught)) { gotData = true; dataResponse[responseIndex] = dataCaught; responseIndex++; } } while (millis() <= initTime && !gotData); if (gotData) { ECUconnection = true; // update for correct delta time in trip calculations. old_time = millis(); // Note: we do not actually validate this connection. It would be best to validate the connection. // Can someone validate this with a car that actually uses this connection? } ISO_InitStep = 0; } break; } #else #error No ISO protocol defined #endif // protocol #ifdef skip_ISO_Init // Need initial parammeters reading after successfull initialization if (ECUconnection) { // check supported PIDs check_supported_pids(); old_time=millis(); // epoch getpid_time=old_time; } #endif } #endif // ELM or ISO init // remap pid to name array index byte remap_pid(byte pid) { return pid > LAST_PID ? pid - FIRST_FAKE_PID + LAST_PID + 1 : pid; } // return false if pid is not supported, true if it is. // mode is 0 for get_pid() and 1 for menu config to allow pid > 0xF0 boolean is_pid_supported(byte pid, byte mode) { if(pid==0) return true; else if(pid<=0x20) { if(1L<<(byte)(0x20-pid) & pid01to20_support) return true; } else if(pid<=0x40) { if(1L<<(byte)(0x40-pid) & pid21to40_support) return true; } else if(pid<=0x60) { if(1L<<(byte)(0x60-pid) & pid41to60_support) return true; } else if (mode && pid>=FIRST_FAKE_PID) return true; return false; } // Get value of a PID, and place in long pointer // and also formatted for string output in the return buffer // Return value denotes successful retrieval of PID. // User must pass in a long pointer to get the PID value. boolean get_pid(byte pid, char *retbuf, long *ret) { #ifdef ELM char cmd_str[6]; // to send to ELM char str[STRLEN]; // to receive from ELM #else byte cmd[2]; // to send the command #endif byte i; byte buf[10]; // to receive the result byte reslen; char decs[16]; unsigned long time_now, delta_time; static byte nbpid=0; nbpid++; // time elapsed time_now = millis(); delta_time = (long)(time_now - getpid_time); if(delta_time>1000) { nbpid_per_second=nbpid; nbpid=0; getpid_time=time_now; } // check if PID is supported (should not happen except for some 0xFn) if(!is_pid_supported(pid, 0)) { // nope sprintf_P(retbuf, PSTR("%02X N/A"), pid); return false; } #ifdef UsePIDCache // Check if PID is available in PID cache byte j=0; while (j < PIDCacheCount && PIDCache[j].PID != pid) j++; if (j < PIDCacheCount) { *ret=PIDCache[j].Value; strcpy(retbuf, PIDCache[j].String); // strcpy_P(retbuf, PIDCacheString[j]); return true; } #endif // receive length depends on pid reslen=pgm_read_byte_near(pid_reslen+pid); #ifdef ELM sprintf_P(cmd_str, PSTR("01%02X\r"), pid); elm_write(cmd_str); #ifndef DEBUG elm_read(str, STRLEN); if(elm_check_response(cmd_str, str)!=0) { strcpy_P(retbuf, PSTR("ERROR")); return false; } // first 2 bytes are 0x41 and command, skip them, // convert response in hex and return in buf elm_compact_response(buf, str); #endif #else // if not connected - do not send any request, // and do not disturb init proccess in case of reinit if (!ECUconnection) return false; // wait until ISORequestDelay is delayed after last PID read while (long(millis() - ISORequestDelay) < lastReceivedPIDTime) delay(1); cmd[0]=0x01; // ISO cmd 1, get PID cmd[1]=pid; // send command, length 2 iso_write_data(cmd, 2); // read requested length, n bytes received in buf if (iso_read_data(buf, reslen) != reslen) { #ifndef DEBUG strcpy_P(retbuf, PSTR("ERROR")); return false; #endif } #endif // a lot of formulas are the same so calculate a default return value here // even if it's scrapped after, we still saved 40 bytes! *ret=buf[0]*256U+buf[1]; // formula and unit for each PID switch(pid) { case ENGINE_RPM: #ifdef DEBUG *ret=1726; #else *ret=*ret/4U; #endif sprintf_P(retbuf, PSTR("%ld RPM"), *ret); break; case MAF_AIR_FLOW: #ifdef DEBUG *ret=2048; #endif // ret is not divided by 100 for return value!! long_to_dec_str(*ret, decs, 2); sprintf_P(retbuf, PSTR("%s g/s"), decs); break; case VEHICLE_SPEED: #ifdef DEBUG *ret=100; #else *ret=(buf[0] * params.speed_adjust) / 100U; #endif #ifdef AllowChangeUnits if(!params.use_metric) *ret=(*ret*1000U)/1609U; #else #ifdef UseSI #endif #ifdef UseUS *ret=(*ret*1000U)/1609U; #endif #endif sprintf_P(retbuf, pctldpcts, *ret, #ifdef AllowChangeUnits params.use_metric?"\003\004":"\006\004" #else #ifdef UseSI "\003\004" #endif #ifdef UseUS "\006\004" #endif #endif ); // do not touch vss, it is used by fuel calculation after, so reset it #ifdef DEBUG *ret=100; #else *ret=(buf[0] * params.speed_adjust) / 100U; #endif break; case FUEL_STATUS: #ifdef DEBUG *ret=0x0200; #endif if(buf[0]==0x01) strcpy_P(retbuf, PSTR("OPENLOWT")); // open due to insufficient engine temperature else if(buf[0]==0x02) strcpy_P(retbuf, PSTR("CLSEOXYS")); // Closed loop, using oxygen sensor feedback to determine fuel mix. should be almost always this else if(buf[0]==0x04) strcpy_P(retbuf, PSTR("OPENLOAD")); // Open loop due to engine load, can trigger DFCO else if(buf[0]==0x08) strcpy_P(retbuf, PSTR("OPENFAIL")); // Open loop due to system failure else if(buf[0]==0x10) strcpy_P(retbuf, PSTR("CLSEBADF")); // Closed loop, using at least one oxygen sensor but there is a fault in the feedback system else sprintf_P(retbuf, PSTR("%04lX"), *ret); break; case LOAD_VALUE: case THROTTLE_POS: case REL_THR_POS: case EGR: case EGR_ERROR: case FUEL_LEVEL: case ABS_THR_POS_B: case ABS_THR_POS_C: case ACCEL_PEDAL_D: case ACCEL_PEDAL_E: case ACCEL_PEDAL_F: case CMD_THR_ACTU: #ifdef DEBUG *ret=17; #else *ret=(buf[0]*100U)/255U; #endif sprintf_P(retbuf, PSTR("%ld %%"), *ret); break; case ABS_LOAD_VAL: *ret=(*ret*100)/255; sprintf_P(retbuf, PSTR("%ld %%"), *ret); break; case B1S1_O2_V: case B1S2_O2_V: case B1S3_O2_V: case B1S4_O2_V: case B2S1_O2_V: case B2S2_O2_V: case B2S3_O2_V: case B2S4_O2_V: *ret=buf[0]*5U; // not divided by 1000 for return!! if(buf[1]==0xFF) // not used in trim calculation sprintf_P(retbuf, PSTR("%ld mV"), *ret); else sprintf_P(retbuf, PSTR("%ldmV/%d%%"), *ret, ((buf[1]-128)*100)/128); break; case O2S1_WR_V: case O2S2_WR_V: case O2S3_WR_V: case O2S4_WR_V: case O2S5_WR_V: case O2S6_WR_V: case O2S7_WR_V: case O2S8_WR_V: case O2S1_WR_C: case O2S2_WR_C: case O2S3_WR_C: case O2S4_WR_C: case O2S5_WR_C: case O2S6_WR_C: case O2S7_WR_C: case O2S8_WR_C: case CMD_EQUIV_R: *ret=(*ret*100)/32768; // not divided by 1000 for return!! long_to_dec_str(*ret, decs, 2); sprintf_P(retbuf, PSTR("l:%s"), decs); break; case DIST_MIL_ON: case DIST_MIL_CLR: #ifdef AllowChangeUnits if(!params.use_metric) *ret=(*ret*1000U)/1609U; #else #ifdef UseSI #endif #ifdef UseUS *ret=(*ret*1000U)/1609U; #endif #endif sprintf_P(retbuf, pctldpcts, *ret, #ifdef AllowChangeUnits params.use_metric?"\003":"\006" #else #ifdef UseSI "\003" #endif #ifdef UseUS "\006" #endif #endif ); break; case TIME_MIL_ON: case TIME_MIL_CLR: sprintf_P(retbuf, PSTR("%ld min"), *ret); break; case COOLANT_TEMP: case INT_AIR_TEMP: case AMBIENT_TEMP: case CAT_TEMP_B1S1: case CAT_TEMP_B2S1: case CAT_TEMP_B1S2: case CAT_TEMP_B2S2: if(pid>=CAT_TEMP_B1S1 && pid<=CAT_TEMP_B2S2) #ifdef DEBUG *ret=600; #else *ret=*ret/10U - 40; #endif else #ifdef DEBUG *ret=40; #else *ret=buf[0]-40; #endif #ifdef AllowChangeUnits if(!params.use_metric) *ret=(*ret*9)/5+32; #else #ifdef UseSI #endif #ifdef UseUS *ret=(*ret*9)/5+32; #endif #endif sprintf_P(retbuf, PSTR("%ld\005%c"), *ret, #ifdef AllowChangeUnits params.use_metric?'C':'F' #else #ifdef UseSI 'C' #endif #ifdef UseUS 'F' #endif #endif ); break; case STFT_BANK1: case LTFT_BANK1: case STFT_BANK2: case LTFT_BANK2: *ret=buf[0]; // Added to avoid 65536 limitation in next operation *ret=(*ret-128)*7812; // not divided by 10000 for return value long_to_dec_str(*ret/100, decs, 2); sprintf_P(retbuf, PSTR("%s %%"), decs); break; case FUEL_PRESSURE: case MAN_PRESSURE: case BARO_PRESSURE: *ret=buf[0]; if(pid==FUEL_PRESSURE) *ret*=3U; sprintf_P(retbuf, PSTR("%ld kPa"), *ret); break; case EVAP_PRESSURE: *ret=((int)buf[0]*256+buf[1])/4; sprintf_P(retbuf, PSTR("%d kPa"), (int)*ret); break; case TIMING_ADV: *ret=(buf[0]/2)-64; sprintf_P(retbuf, PSTR("%ld\005"), *ret); break; case CTRL_MOD_V: long_to_dec_str(*ret/10, decs, 2); sprintf_P(retbuf, PSTR("%s V"), decs); break; case RUNTIME_START: sprintf_P(retbuf, PSTR("%u:%02u:%02u"), (unsigned int)*ret/3600, (unsigned int)(*ret/60)%60, (unsigned int)*ret%60); break; case OBD_STD: *ret=buf[0]; if(buf[0]<=0x11) strcpy_P(retbuf, obd_std_strings[buf[0]-1]); else sprintf_P(retbuf, PSTR("OBD:%02X"), buf[0]); break; // for the moment, everything else, display the raw answer default: // transform buffer to an hex value *ret=0; for(i=0; i<reslen; i++) { *ret*=256L; *ret+=buf[i]; } sprintf_P(retbuf, PSTR("%08lX"), *ret); break; } #ifdef UsePIDCache // Write result to PID cache if (PIDCacheCount < MaxPIDCacheCount) { PIDCache[PIDCacheCount].PID = pid; PIDCache[PIDCacheCount].Value = *ret; PIDCache[PIDCacheCount].Time = millis(); // strcpy_P(PIDCacheString[PIDCacheCount], retbuf); strcpy(PIDCache[PIDCacheCount].String, retbuf); PIDCacheCount++; } #endif #ifdef logEveryPid logpid(pid, retbuf, ret); #endif return true; } // ex: get a long as 687 with prec 2 and output the string "6.87" // precision is 1 or 2 void long_to_dec_str(long value, char *decs, byte prec) { byte pos; // sprintf_P does not allow * for the width so manually change precision sprintf_P(decs, prec==2?PSTR("%03ld"):PSTR("%02ld"), value); pos=strlen(decs)+1; // move the \0 too // a simple loop takes less space than memmove() for(byte i=0; i<=prec; i++) { decs[pos]=decs[pos-1]; // move digit pos--; } // then insert decimal separator decs[pos] = (params.use_metric && params.use_comma) ? ',' : '.'; } #ifdef BatteryVoltageSensor // Wiring: // 12V ---- 30kOhm ---|--- 10kOhm ---- 0V(GND) // | // A0 (analog pin) void get_batteryvoltage(char *retbuf) { #define VoltageDevider 1955L // (30kOhm+10kOhm) / 10kOhm * 5V / 1023 * 100000 long Voltage = analogRead(BatteryVoltagePin-14); #ifdef DEBUGOutput Voltage = 535; #endif Voltage = (Voltage * VoltageDevider) / 1000L; char decs[16]; long_to_dec_str(Voltage, decs, 2); sprintf_P(retbuf, PSTR("%s V"), decs); } #endif #if defined UseInsideTemperatureSensor || defined UseOutsideTemperatureSensor void get_temperature(char *retbuf, byte TemperatureSensorPin) { #ifdef TemperatureSensorTypeKTY81_210 #define TemperatureSensorReferenceResistance 2000L // 2kOhm #define TemperatureListSize 17 static prog_int16_t TemperatureList[TemperatureListSize][2] PROGMEM = { {1135, -400}, {1247, -300}, {1367, -200}, {1495, -100}, {1630, 0}, {1772, 100}, {1922, 200}, {2080, 300}, {2245, 400}, {2417, 500}, {2597, 600}, {2785, 700}, {2980, 800}, {3182, 900}, {3392, 1000}, {3607, 1100}, {3817, 1200} }; #endif int Voltage = analogRead(TemperatureSensorPin - 14); char decs[16]; #ifdef DEBUGOutput Voltage = 535; #endif // convert from V to R(ohm) long Resistance = (Voltage * TemperatureSensorReferenceResistance) / (1024 - Voltage); // convert from R to �C int Temperature = -450; int LowestResistance = pgm_read_word(&(TemperatureList[0][0])); if (Resistance > LowestResistance) { byte TemperatureIndex = 0; while (TemperatureIndex < TemperatureListSize - 1 && Resistance > pgm_read_word(&(TemperatureList[TemperatureIndex + 1][0]))) TemperatureIndex++; if (TemperatureIndex < TemperatureListSize - 1) { int UpperResistance = pgm_read_word(&(TemperatureList[TemperatureIndex + 1][0])); int LowerResistance = pgm_read_word(&(TemperatureList[TemperatureIndex][0])); int ResistanceTemperature = pgm_read_word(&(TemperatureList[TemperatureIndex][1])); Temperature = ResistanceTemperature + (Resistance - LowerResistance) * 100 / (UpperResistance - LowerResistance); } else Temperature = 1250; } Temperature = Temperature - 15; // Sensor is showing 1.5�C more then realy it is // convert �C in F if requested #ifdef AllowChangeUnits if(!params.use_metric) Temperature = convertToFarenheit(Temperature); #else #ifdef UseSI #endif #ifdef UseUS Temperature = convertToFarenheit(Temperature); #endif #endif long_to_dec_str(Temperature, decs, 1); sprintf_P(retbuf, PSTR("%s\005%c"), decs, #ifdef AllowChangeUnits params.use_metric?'C':'F' #else #ifdef UseSI 'C' #endif #ifdef UseUS 'F' #endif #endif ); } #endif #define NBSMOOTH 8 byte tvss[NBSMOOTH]; // last n speed unsigned int tmaf[NBSMOOTH]; // last n MAF static void clear_icons_tvss(void) { for(byte i=0; i<NBSMOOTH; i++) tvss[i]=0; } static void clear_icons_tmaf(void) { for(byte i=0; i<NBSMOOTH; i++) tmaf[i]=0; } // instant fuel consumption unsigned int get_icons(char *retbuf) { unsigned int vss=0; unsigned long maf=0; byte nb_entry=0; long cons; char decs[16]; long toggle_speed = params.per_hour_speed; #ifdef AllowChangeUnits if (!params.use_metric) toggle_speed = (toggle_speed *1609) / 1000; #else #ifdef UseSI #endif #ifdef UseUS toggle_speed = (toggle_speed *1609) / 1000; #endif #endif for(byte i=0; i<NBSMOOTH; i++) { vss+=tvss[i]; maf+=tmaf[i]; if(tmaf[i]!=0) nb_entry++; } if(nb_entry!=0) { maf=(maf*params.fuel_adjust)/((unsigned int)nb_entry*100); } vss/=NBSMOOTH; // average the N latest speed // divide MAF by 100 because our function return MAF*100 // but multiply by 100 for double digits precision // divide MAF by 14.7 air/fuel ratio to have g of fuel/s // divide by 730 (g/L at 15C) according to Canadian Gov to have L/s // multiply by 3600 to get litre per hour // formula: (3600 * MAF) / (14.7 * 730 * VSS) // = maf*0.3355/vss L/km // mul by 100 to have L/100km //need to remember if speed was too low, because later it is //multiplied by speed_adjust and does not match condition anymore boolean lowSpeed = false; if(vss<toggle_speed) { vss=10000; lowSpeed=true; } else vss*=params.speed_adjust; // if maf is 0 it will just output 0 cons=(maf * GasConst)/vss; // MPG // 6.17 pounds per gallon // 454 g in a pound // 14.7 * 6.17 * 454 * (VSS * 0.621371) / (3600 * MAF / 100) // multipled by 10 for single digit precision // new comment: convert from L/100 to MPG #ifdef AllowChangeUnits if(!params.use_metric) { if(lowSpeed) cons=(cons*10)/378; // convert to gallon, can be 0 G/h else { if(cons==0) // if cons is 0 (DFCO?) display 999.9MPG cons=9999; else cons=235214/cons; // convert to MPG } } #else #ifdef UseSI #endif #ifdef UseUS if(lowSpeed) cons=(cons*10)/378; // convert to gallon, can be 0 G/h else { if(cons==0) // if cons is 0 (DFCO?) display 999.9MPG cons=9999; else cons=235214/cons; // convert to MPG } #endif #endif long_to_dec_str(cons, decs, (1+params.use_metric)); sprintf_P(retbuf, pctspcts, decs, #ifdef AllowChangeUnits params.use_metric?(lowSpeed?"L\004":"\001\002"):(lowSpeed?"G\004":"\006\007") #else #ifdef UseSI lowSpeed?"L\004":"\001\002" #endif #ifdef UseUS lowSpeed?"G\004":"\006\007" #endif #endif ); return (unsigned int) cons; } // trip 0 is tank // trip 1 is trip // trip 2 is outing unsigned int get_cons(char *retbuf, byte ctrip) { unsigned long cfuel; unsigned long cdist; long trip_cons; char decs[16]; cfuel=params.trip[ctrip].fuel; cdist=params.trip[ctrip].dist; // the car has not moved yet or no fuel used if(cdist<1000 || cfuel==0) { // will display 0.00L/100 or 999.9mpg trip_cons=0; #ifdef AllowChangeUnits if (!params.use_metric) trip_cons=9999; #else #ifdef UseSI #endif #ifdef UseUS trip_cons=9999; #endif #endif } else // the car has moved and fuel used { // from uL/cm to L/100 so div by 1000000 for L and mul by 10000000 for 100km // multiply by 100 to have 2 digits precision // we can not mul fuel by 1000 else it can go higher than ULONG_MAX // so divide distance by 1000 instead (resolution of 10 metres) trip_cons=cfuel/(cdist/1000); // div by 0 avoided by previous test #ifdef AllowChangeUnits if(params.use_metric) { if(trip_cons>9999) // SI trip_cons=9999; // display 99.99 L/100 maximum } else { // it's imperial, convert. // from m/mL to MPG so * by 3.78541178 to have gallon and * by 0.621371 for mile // multiply by 10 to have a digit precision // new comment: convert L/100 to MPG trip_cons=235214/trip_cons; if(trip_cons<10) trip_cons=10; // display 1.0 MPG min } #else #ifdef UseSI if(trip_cons>9999) // SI trip_cons=9999; // display 99.99 L/100 maximum #endif #ifdef UseUS trip_cons=235214/trip_cons; if(trip_cons<10) trip_cons=10; // display 1.0 MPG min #endif #endif } #if 1 long_to_dec_str(trip_cons, decs, (1+params.use_metric)); // hack #else if(params.use_metric) long_to_dec_str(trip_cons, decs, 2); else long_to_dec_str(trip_cons, decs, 1); #endif sprintf_P(retbuf, pctspcts, decs, #ifdef AllowChangeUnits params.use_metric?"\001\002":"\006\007" #else #ifdef UseSI "\001\002" #endif #ifdef UseUS "\006\007" #endif #endif ); return (unsigned int)trip_cons; } // trip 0 is tank // trip 1 is trip // trip 2 is outing void get_fuel(char *retbuf, byte ctrip) { unsigned long cfuel; char decs[16]; // convert from uL to cL cfuel=params.trip[ctrip].fuel/10000; // convert in gallon if requested #ifdef AllowChangeUnits if(!params.use_metric) cfuel = (cfuel * 100L) / 378L;//convertToGallons(cfuel); #else #ifdef UseSI #endif #ifdef UseUS cfuel = (cfuel * 100L) / 378L;//convertToGallons(cfuel); #endif #endif long_to_dec_str(cfuel, decs, 2); sprintf_P(retbuf, pctspcts, decs, #ifdef AllowChangeUnits params.use_metric?"L":"G" #else #ifdef UseSI "L" #endif #ifdef UseUS "G" #endif #endif ); } // trip 0 is tank // trip 1 is trip // trip 2 is outing void get_waste(char *retbuf, byte ctrip) { unsigned long cfuel; char decs[16]; // convert from uL to cL cfuel=params.trip[ctrip].waste/10000; // convert in gallon if requested #ifdef AllowChangeUnits if(!params.use_metric) cfuel = (cfuel * 100L) / 378L;//convertToGallons(cfuel); #else #ifdef UseSI #endif #ifdef UseUS cfuel = (cfuel * 100L) / 378L;//convertToGallons(cfuel); #endif #endif long_to_dec_str(cfuel, decs, 2); sprintf_P(retbuf, pctspcts, decs, #ifdef AllowChangeUnits params.use_metric?"L":"G" #else #ifdef UseSI "L" #endif #ifdef UseUS "G" #endif #endif ); } // trip 0 is tank // trip 1 is trip // trip 2 is outing void get_dist(char *retbuf, byte ctrip) { unsigned long cdist; char decs[16]; // convert from cm to hundreds of meter cdist=params.trip[ctrip].dist/10000; // convert in miles if requested #ifdef AllowChangeUnits if(!params.use_metric) cdist=(cdist*1000)/1609; #else #ifdef UseSI #endif #ifdef UseUS cdist=(cdist*1000)/1609; #endif #endif long_to_dec_str(cdist, decs, 1); sprintf_P(retbuf, pctspcts, decs, #ifdef AllowChangeUnits params.use_metric?"\003":"\006" #else #ifdef UseSI "\003" #endif #ifdef UseUS "\006" #endif #endif ); } // distance you can do with the remaining fuel in your tank void get_remain_dist(char *retbuf) { long tank_tmp; long remain_dist; long remain_fuel; long tank_cons; // tank size is in litres (converted at input time) tank_tmp=params.tank_size; // convert from uL to dL remain_fuel=tank_tmp - params.trip[TANK].fuel/100000; // calculate remaining distance using tank cons and remaining fuel if(params.trip[TANK].dist<1000) remain_dist=9999; else { tank_cons=params.trip[TANK].fuel/(params.trip[TANK].dist/1000); remain_dist=remain_fuel*1000/tank_cons; #ifdef AllowChangeUnits if(!params.use_metric) // convert to miles remain_dist=(remain_dist*1000)/1609; #else #ifdef UseSI #endif #ifdef UseUS remain_dist=(remain_dist*1000)/1609; #endif #endif } sprintf_P(retbuf, pctldpcts, remain_dist, #ifdef AllowChangeUnits params.use_metric?"\003":"\006" #else #ifdef UseSI "\003" #endif #ifdef UseUS "\006" #endif #endif ); } //get_max_vss returns max speed achieved in trip void get_max_vss(char *retbuf, byte trip) { long maxspeed = params.tripmax[trip].maxspeed; #ifdef AllowChangeUnits if(!params.use_metric) maxspeed=(maxspeed*100U)/161U; //low differense between 1609 and 1610 #else #ifdef UseSI #endif #ifdef UseUS maxspeed=(maxspeed*100U)/161U; //low differense between 1609 and 1610 #endif #endif sprintf_P(retbuf, pctldpcts, maxspeed, #ifdef AllowChangeUnits params.use_metric?"\003\004":"\006\004" #else #ifdef UseSI "\003\004" #endif #ifdef UseUS "\006\004" #endif #endif ); } /* * accumulate data for trip, called every loop() */ void accu_trip(void) { static byte tindex=0; // index in the smoothing table static byte min_throttle_pos=255; // idle throttle position, start high byte throttle_pos; // current throttle position byte open_load; // to detect open loop char str[STRLEN]; unsigned long delta_dist, delta_fuel; unsigned long time_now, delta_time; #ifdef UsePIDCache // read values from ECU, not from cache PIDCacheCount=0; #endif // if we return early set MAF to 0 maf=0; // time elapsed time_now = millis(); delta_time = (long)(time_now - old_time); //must take care of rollover old_time = time_now; // distance in cm // 3km/h = 83cm/s and we can sample n times per second or so with CAN // so having the value in cm is not too large, not too weak. // ulong so max value is 4'294'967'295 cm or 42'949 km or 26'671 miles if (!get_pid(VEHICLE_SPEED, str, &vss)) { return; // not valid, exit } if ((byte)vss>0) { delta_dist=(vss*delta_time)/36; // accumulate for all trips for(byte i=0; i<NBTRIP; i++) { params.trip[i].dist+=delta_dist; // collect max data if ((byte)vss > params.tripmax[i].maxspeed) params.tripmax[i].maxspeed = (byte)vss; } } #ifdef UseBuzzer if ((byte)vss > SpeedLimit) { if (!SpeedLimitReached) { Buzzer(20); //20*10ms=200ms SpeedLimitReached = true; } } // Allow to drop speed before beeping again if ((byte)vss < SpeedLimit - 5) SpeedLimitReached = false; if ((long)(time_now - old_time_system_check) > 1L * 60000L) // more then 1min { boolean SomethingWrong = false; old_time_system_check = millis(); if (get_pid(COOLANT_TEMP, str, &tempLong)) if ((byte)tempLong >= CoolantTemperatureLimit) SomethingWrong = true; // if (get_pid(MIL_CODE, str, &tempLong)) // if (1L<<31 & (unsigned long)tempLong) // SomethingWrong = true; if (SomethingWrong) { Buzzer(10); Buzzer(-10); Buzzer(10); Buzzer(-10); Buzzer(10); } } #endif // if engine is stopped, we can get out now if (!has_rpm) { return; } // need auto-save if car is running #ifdef AutoSave if ((long)(time_now - old_time_params) > 30L * 60000L) // more then 30min params_save(); #endif // accumulate fuel only if not in DFCO // if throttle position is close to idle and we are in open loop -> DFCO // detect idle pos if (get_pid(THROTTLE_POS, str, &tempLong)) { throttle_pos = (byte)tempLong; if(throttle_pos<min_throttle_pos && throttle_pos != 0) //And make sure its not '0' returned by no response in read byte function min_throttle_pos=throttle_pos; } else { return; } // get fuel status if(get_pid(FUEL_STATUS, str, &tempLong)) { open_load = (tempLong & 0x0400) ? 1 : 0; } else { return; } if(throttle_pos<(min_throttle_pos+4) && open_load) { clear_icons_tmaf(); maf=0; // decellerate fuel cut-off, fake the MAF as 0 :) } else { // check if MAF is supported if(is_pid_supported(MAF_AIR_FLOW, 0)) { // yes, just request it maf = (get_pid(MAF_AIR_FLOW, str, &tempLong)) ? tempLong : 0; } else { /* I just hope if you don't have a MAF, you have a MAP!! No MAF (Uses MAP and Absolute Temp to approximate MAF): IMAP = RPM * MAP / IAT MAF = (IMAP/120)*(VE/100)*(ED)*(MM)/(R) MAP - Manifold Absolute Pressure in kPa IAT - Intake Air Temperature in Kelvin R - Specific Gas Constant (8.314472 J/(mol.K) MM - Average molecular mass of air (28.9644 g/mol) VE - volumetric efficiency measured in percent, let's say 80% ED - Engine Displacement in liters This method requires tweaking of the VE for accuracy. */ long imap, rpm, manp, iat; // get_pid successful, assign variable, otherwise quit if (get_pid(ENGINE_RPM, str, &engineRPM)) rpm = engineRPM; else return; if (get_pid(MAN_PRESSURE, str, &tempLong)) manp = tempLong; else return; if (get_pid(INT_AIR_TEMP, str, &tempLong)) iat = tempLong; else return; imap=(rpm*manp)/(iat+273); // does not divide by 100 at the end because we use (MAF*100) in formula // but divide by 10 because engine displacement is in dL // imap * VE * ED * MM / (120 * 100 * R * 10) = 0.0020321 // ex: VSS=80km/h, MAP=64kPa, RPM=1800, IAT=21C // engine=2.2L, efficiency=70% // maf = ( (1800*64)/(21+273) * 22 * 20 ) / 100 // maf = 17.24 g/s which is about right at 80km/h maf=(imap*params.eng_dis)/5; } // add MAF result to trip // we want fuel used in uL // maf gives grams of air/s // divide by 100 because our MAF return is not divided! // divide by 14.7 (a/f ratio) to have grams of fuel/s // divide by 730 to have L/s // mul by 1000000 to have uL/s // divide by 1000 because delta_time is in ms // at idle MAF output is about 2.25 g of air /s on my car // so about 0.15g of fuel or 0.210 mL // or about 210 uL of fuel/s so uL is not too weak nor too large // as we sample about 4 times per second at 9600 bauds // ulong so max value is 4'294'967'295 uL or 4'294 L (about 1136 gallon) // also, adjust maf with fuel param, will be used to display instant cons delta_fuel=(maf*params.fuel_adjust*delta_time) / GasMafConst; for(byte i=0; i<NBTRIP; i++) { params.trip[i].fuel+=delta_fuel; //code to accumlate fuel wasted while idling if ( vss == 0 ) {//car not moving params.trip[i].waste+=delta_fuel; params.tripmax[i].timeidling += delta_time; } else params.tripmax[i].timedriving += delta_time; // collect max data if (maf > params.tripmax[i].maxmaf) params.tripmax[i].maxmaf = maf; } } tvss[tindex]=vss; tmaf[tindex]=maf; // increment index and roll over tindex = (tindex+1) % NBSMOOTH; #ifdef logDataCollections //log data speed, maf, etc logdata(throttle_pos); #endif } // this function is needet for normal PID display and BIG PID display // as well in this form, compiled size is lower in 70bytes, why? void get_pid_internal(char *str, byte pid) { /* check if it's a real PID or our internal one */ if(pid==NO_DISPLAY) return; else if(pid==OUTING_MAX_VSS) get_max_vss(str, OUTING); else if(pid==TRIP_MAX_VSS) get_max_vss(str, TRIP); else if(pid==TANK_MAX_VSS) get_max_vss(str, TANK); else if(pid==OUTING_IDLE_TIME) get_trip_time(str, OUTING, 1); else if(pid==TRIP_IDLE_TIME) get_trip_time(str, TRIP, 1); else if(pid==TANK_IDLE_TIME) get_trip_time(str, TANK, 1); else if(pid==OUTING_DRIVE_TIME) get_trip_time(str, OUTING, 0); else if(pid==TRIP_DRIVE_TIME) get_trip_time(str, TRIP, 0); else if(pid==TANK_DRIVE_TIME) get_trip_time(str, TANK, 0); else if(pid==OUTING_COST) get_cost(str, OUTING); else if(pid==TRIP_COST) get_cost(str, TRIP); else if(pid==TANK_COST) get_cost(str, TANK); else if(pid==ENGINE_ON) get_engine_on_time(str); else if(pid==FUEL_CONS) get_icons(str); else if(pid==TANK_CONS) get_cons(str, TANK); else if(pid==TANK_FUEL) get_fuel(str, TANK); else if (pid==TANK_WASTE) get_waste(str,TANK); else if(pid==TANK_DIST) get_dist(str, TANK); else if(pid==REMAIN_DIST) get_remain_dist(str); else if(pid==TRIP_CONS) get_cons(str, TRIP); else if(pid==TRIP_FUEL) get_fuel(str, TRIP); else if (pid==TRIP_WASTE) get_waste(str,TRIP); else if(pid==TRIP_DIST) get_dist(str, TRIP); #ifdef ELM else if(pid==BATT_VOLTAGE) elm_command(str, PSTR("ATRV\r")); else if(pid==CAN_STATUS) elm_command(str, PSTR("ATCS\r")); #endif #ifdef BatteryVoltageSensor else if(pid==BATT_VOLTAGE) get_batteryvoltage(str); #endif else if (pid==OUTING_CONS) get_cons(str,OUTING); else if (pid==OUTING_FUEL) get_fuel(str,OUTING); else if (pid==OUTING_WASTE) get_waste(str,OUTING); else if (pid==OUTING_DIST) get_dist(str,OUTING); #ifdef UseInsideTemperatureSensor else if (pid==INSIDE_TEMP) get_temperature(str, InsideTemperaturePin); #endif #ifdef UseOutsideTemperatureSensor else if (pid==OUTSIDE_TEMP) get_temperature(str, OutsideTemperaturePin); #endif else if(pid==PID_SEC) sprintf_P(str, PSTR("%d pid/s"), nbpid_per_second); #ifdef DEBUG else if(pid==FREE_MEM) sprintf_P(str, PSTR("%d free"), memoryTest()); #else else if(pid==ECO_VISUAL) eco_visual(str); #endif else get_pid(pid, str, &tempLong); } void display(byte location, byte pid) { char str[STRLEN]; if(pid==NO_DISPLAY) return; get_pid_internal(str, pid); // left locations are left aligned // right locations are right aligned // truncate any string that is too long to display correctly str[LCD_SPLIT] = '\0'; byte row = location / 2; // Two PIDs per line boolean isLeft = location % 2 == 0; // First PID per line is always left // CodeOptimization (10 bytes) // same "if condition" should be done in one "if" // byte textPos = isLeft ? 0 : LCD_COLS - strlen(str); // byte clearStart = isLeft ? strlen(str) : LCD_SPLIT; // byte clearEnd = isLeft ? LCD_SPLIT : textPos; byte textPos = 0; byte clearStart = strlen(str); byte clearEnd = LCD_SPLIT; if (!isLeft) { textPos = LCD_COLS - strlen(str); clearStart = LCD_SPLIT; clearEnd = textPos; } lcd.setCursor(textPos,row); lcd.print(str); // clean up any possible leading or trailing data lcd.setCursor(clearStart,row); for (byte cleanup = clearStart; cleanup < clearEnd; cleanup++) { lcd.write(' '); } } void check_supported_pids(void) { char str[STRLEN]; //long tempPID; //local variable is 4bytes less then global tempLong, why? #ifdef DEBUG pid01to20_support=0xBE1FA812; #else // on some ECU first PID read attemts some time fails, changed to 3 attempts for (byte i=0; i<3; i++) { pid01to20_support = (get_pid(PID_SUPPORT00, str, &tempLong)) ? tempLong : 0; if (pid01to20_support) break; } #endif if(is_pid_supported(PID_SUPPORT20, 0)) if (get_pid(PID_SUPPORT20, str, &tempLong)) pid21to40_support = tempLong; if(is_pid_supported(PID_SUPPORT40, 0)) if (get_pid(PID_SUPPORT40, str, &tempLong)) pid41to60_support = tempLong; } void display_mil_code_count(char *str, unsigned long *n, byte *count) { // we have MIL on *count=(*n>>24) & 0x7F; lcd_cls_print_P(PSTR("CHECK ENGINE ON")); lcd.setCursor(0,1); sprintf_P(str, PSTR("%d CODE(S) IN ECU"), *count); lcd.print(str); delay(1500); lcd.clear(); } // might be incomplete void check_mil_code(bool Silent) { unsigned long n; char str[STRLEN]; byte nb; #ifndef ELM byte cmd[2]; byte i, j, k; #endif #ifndef ELM Serial.flush(); #endif; if (!get_pid(MIL_CODE, str, &tempLong)) return; // Invalid return so abort n = (unsigned long) tempLong; /* A request for this PID returns 4 bytes of data. The first byte contains two pieces of information. Bit A7 (the seventh bit of byte A, the first byte) indicates whether or not the MIL (check engine light) is illuminated. Bits A0 through A6 represent the number of diagnostic trouble codes currently flagged in the ECU. The second, third, and fourth bytes give information about the availability and completeness of certain on-board tests. Note that test availability signified by set (1) bit; completeness signified by reset (0) bit. (from Wikipedia) */ if(1L<<31 & n) // test bit A7 { display_mil_code_count(str, &n, &nb); #ifdef ELM // retrieve code elm_command(str, PSTR("03\r")); // ELM returns something like 43 01 33 00 00 00 00 if(str[0]!='4' && str[1]!='3') return; // something wrong // must convert to P/C/B/U etc lcd.print(str+3); delay(5000); #else // we display only the first 6 codes // if you have more than 6 in your ECU // your car is obviously wrong :-/ // retrieve code cmd[0]=0x03; iso_write_data(cmd, 1); // Reading ECU in raw method (normal method is wrong because of different size header 5 vs 4) byte DTCBuf[32]; int DTCBufSize = 0; // Wait until first byte available byte i = 0; byte b; while(i < 3 && !iso_read_byte(&b)) { i++; } if (i == 3) { lcd_cls_print_P(PSTR("Error reading DTC")); delay(2000); lcd.clear(); return; } DTCBuf[0] = b; DTCBufSize++; // Read until last byte, or until buffer is full while (DTCBufSize < 31 && iso_read_byte(&b)) { DTCBuf[DTCBufSize] = b; DTCBufSize++; } Serial.flush(); // VW Jetta 2001 example read: 48 6B 10 43 04 20 00 00 00 00 2A (11 bytes, 1 DTC) // 48 6B 10 - header // 43 - responce to 03 // 04 20 - first code // 00 00 - second code // 00 00 - third code // 2A - checsum // Next 3 DTC would be same order, all 11 bytes. lcd.clear(); for (j = 0; j < (nb-1)/3 + 1; j++) { k = 0; byte DataShift = (j==0 ? 4 : 15); for (i = 0; i < 3; i++) { if (DTCBuf[DataShift + i*2] > 0 || DTCBuf[DataShift + i*2 + 1] > 0) { switch (DTCBuf[DataShift + i*2] & 0xC0) { case 0x00: str[k]='P'; // powertrain break; case 0x40: str[k]='C'; // chassis break; case 0x80: str[k]='B'; // body break; case 0xC0: str[k]='U'; // network break; } k++; str[k++] = '0' + ((DTCBuf[DataShift + i*2] & 0x30) >> 4); // first digit is 0-3 only str[k++] = '0' + (DTCBuf[DataShift + i*2] & 0x0F); str[k++] = '0' + ((DTCBuf[DataShift + i*2 + 1] & 0xF0) >> 4); str[k++] = '0' + (DTCBuf[DataShift + i*2 + 1] & 0x0F); } } str[k]='\0'; // make asciiz lcd.print(str); lcd.setCursor(0, 1); // go to next line to display the 3 next delay(1000); } delay(2000); lcd_cls_print_P(PSTR("Clear DTC?")); byte ClearDTC = menu_select_yes_no(0); if (ClearDTC == 1) clear_mil_code(); lcd.clear(); #endif } else if (!Silent) { lcd_cls_print_P(noDTCcodes); delay(1500); lcd.clear(); } } // might be incomplete void clear_mil_code(void) { unsigned long n; char str[STRLEN]; byte nb; #ifndef ELM byte cmd[2]; byte buf[6]; byte i, j, k; #endif #ifndef ELM Serial.flush(); #endif; if (!get_pid(MIL_CODE, str, &tempLong)) return; // Invalid return so abort n = (unsigned long) tempLong; /* A request for this PID returns 4 bytes of data. The first byte contains two pieces of information. Bit A7 (the seventh bit of byte A, the first byte) indicates whether or not the MIL (check engine light) is illuminated. Bits A0 through A6 represent the number of diagnostic trouble codes currently flagged in the ECU. The second, third, and fourth bytes give information about the availability and completeness of certain on-board tests. Note that test availability signified by set (1) bit; completeness signified by reset (0) bit. (from Wikipedia) */ if(1L<<31 & n) // test bit A7 { display_mil_code_count(str, &n, &nb); } else { lcd_cls_print_P(noDTCcodes); delay(1000); lcd.clear(); } // Clear codes always. If no MIL is iluminated, clearing codes still clears Long time fuel trim. lcd_cls_print_P(PSTR("Clearing codes...")); #ifdef ELM //Need some code to work :) delay(1000); lcd.clear(); #else // clear code cmd[0]=0x04; iso_write_data(cmd, 1); lcd_cls_print_P(PSTR("Codes cleared")); delay(1000); Serial.flush(); lcd.clear(); #endif } /* * Configuration menu */ boolean delay_reset_button(void) { byte DelayCount = 0; // accumulate data for trip while in the menu config, do not pool too often. // but anyway you should not configure your OBDuino while driving! // If there has been a key press, then don't accumulate trip data just yet, // wait a little past the last key press before doing trip data. // Rapid key presses take priority... static unsigned long lastButtonTime = 0; unsigned int timeSinceLastButton; if (buttonState != buttonsUp) { lastButtonTime = millis(); #ifdef UseBuzzer Buzzer(3); #endif // Waiting until buttons are released (for real) and wait for next button while (analogRead(lbuttonPin-14) + analogRead(mbuttonPin-14) + analogRead(rbuttonPin-14) < 3 * 1024 - 64) delay(50); while (buttonState != buttonsUp) { buttonState = buttonsUp; delay(50); } } else { while (buttonState == buttonsUp && DelayCount < 100) { DelayCount++; //should be unsigned long if timeout is more 60s timeSinceLastButton = calcTimeDiff(lastButtonTime, millis()); //calcTimeDiff uses 40-50bytes each call if (timeSinceLastButton > KEY_WAIT && calcTimeDiff(old_time, millis()) > ACCU_WAIT) { accu_trip(); } if (timeSinceLastButton > MENU_TIMEOUT) return true; // Some delay for less cycles delay(20); } } return false; } // common code used in a couple of menu section byte menu_select_yes_no(byte p) { boolean exitMenu = false; // set value with left/right and set with middle exitMenu = delay_reset_button(); // make sure to clear button do { if(LEFT_BUTTON_PRESSED) p=0; else if(RIGHT_BUTTON_PRESSED) p=1; else if(MIDDLE_BUTTON_PRESSED) exitMenu = true; lcd.setCursor(4,1); if(p==0) lcd_print_P(select_no); else lcd_print_P(select_yes); exitMenu |= delay_reset_button(); } while(!MIDDLE_BUTTON_PRESSED && !exitMenu); return p; } // Menu selection // // This function is passed in a array of strings which comprise of the menu // The first string is the MENU TITLE, // The second string is the EXIT option (always first option) // The following strings are the other options in the menu // // The returned value denotes the selection of the user: // A return of zero represents the exit // A return of a real number represents the selection from the menu past exit (ie 2 would be the second item past EXIT) byte menu_selection(char ** menu, byte arraySize) { byte selection = 1; // Menu title takes up the first string in the list so skip it byte screenChars = 0; // Characters currently sent to screen byte menuItem = 0; // Menu items past current selection boolean exitMenu = false; boolean forceExit = false; // Note: values are changed with left/right and set with middle // Default selection is always the first selection, which should be 'Exit' lcd.clear(); lcd.print((char *)pgm_read_word(&(menu[0]))); forceExit = delay_reset_button(); // make sure to clear button if (forceExit) return 0; // selection "exit" do { if(LEFT_BUTTON_PRESSED && selection > 1) { selection--; } else if(RIGHT_BUTTON_PRESSED && selection < arraySize - 1) { selection++; } else if (MIDDLE_BUTTON_PRESSED) { exitMenu = true; //return from function, menu does not need repaiting return selection - 1; } // Potential improvements: // Currently the selection is ALWAYS the first presented menu item. // Current selection could be in the middle if possible. // If few selections and screen size permits, selections could be centered? lcd.setCursor(0,1); screenChars = 1; lcd.write('('); // Wrap the current selection with brackets menuItem = 0; do { lcd.print((char*)pgm_read_word(&(menu[selection+menuItem]))); if (menuItem == 0) { // include closing bracket lcd.write(')'); screenChars++; } lcd.write(' '); screenChars += (strlen((char*)pgm_read_word(&(menu[selection+menuItem]))) + 1); menuItem++; } while (screenChars < LCD_COLS && selection + menuItem < arraySize); // Do any cover up of old data while (screenChars < LCD_COLS) { lcd.write(' '); screenChars++; } // Clean up button presses forceExit = delay_reset_button(); } while(!MIDDLE_BUTTON_PRESSED && !exitMenu && !forceExit); if (forceExit) return 0; return selection - 1; } void config_menu(void) { char str[STRLEN]; char decs[16]; int lastButton = 0; //we'll use this to speed up button pushes unsigned int fuelUnits = 0; unsigned long tankUnits = 0; boolean changed = false; boolean exitMenu = false; #ifdef ELM #ifndef DEBUG // it takes 98 bytes // display protocol, just for fun lcd.clear(); memset(str, 0, STRLEN); elm_command(str, PSTR("ATDP\r")); if(str[0]=='A') // string start with "AUTO, ", skip it { lcd.print(str+6); lcd.setCursor(0,1); lcd.print(str+6+16); } else { lcd.print(str); lcd.setCursor(0,1); lcd.print(str+16); } delay(2000); #endif #endif boolean saveParams = false; // Currently a button press will cause a save, smarter would be to verify a change in value... byte selection = 0; byte oldByteValue; // used to determine if new value is different and we need to save the change unsigned int oldUIntValue; // ditto unsigned long oldULongValue; // tank used and tank distance adjust do { selection = menu_selection(topMenu, ARRAY_SIZE(topMenu)); if (selection == 1) // display { byte displaySelection = 0; do { displaySelection = menu_selection(displayMenu, ARRAY_SIZE(displayMenu)); if (displaySelection == 1) // Contrast { lcd_cls_print_P(PSTR("LCD contrast")); oldByteValue = params.contrast; do { if(LEFT_BUTTON_PRESSED && params.contrast!=0) params.contrast-=10; else if(RIGHT_BUTTON_PRESSED && params.contrast!=100) params.contrast+=10; analogWrite(ContrastPin, params.contrast); // change dynamicaly sprintf_P(str, pctd, params.contrast); exitMenu = displaySecondLine(5, str); } while(!MIDDLE_BUTTON_PRESSED && !exitMenu); if (oldByteValue != params.contrast) { saveParams = true; } } #ifdef AllowChangeUnits else if (displaySelection == 2) // Metric { lcd_cls_print_P(PSTR("Use metric unit")); oldByteValue = params.use_metric; params.use_metric=menu_select_yes_no(params.use_metric); if (oldByteValue != params.use_metric) { saveParams = true; } // Only if metric do we have the option of using the comma as a decimal if(params.use_metric) { lcd_cls_print_P(PSTR("Use comma format")); oldByteValue = (byte) params.use_comma; params.use_comma = menu_select_yes_no(params.use_comma); if (oldByteValue != (byte) params.use_comma) { saveParams = true; } } } #endif else if (displaySelection == 3) // Display speed { oldByteValue = params.per_hour_speed; // speed from which we toggle to fuel/hour lcd_cls_print_P(PSTR("Fuel/hour speed")); // set value with left/right and set with middle do { if(LEFT_BUTTON_PRESSED && params.per_hour_speed!=0) params.per_hour_speed--; else if(RIGHT_BUTTON_PRESSED && params.per_hour_speed!=255) params.per_hour_speed++; sprintf_P(str, pctd, params.per_hour_speed); exitMenu = displaySecondLine(5, str); } while(!MIDDLE_BUTTON_PRESSED && !exitMenu); if (oldByteValue != params.per_hour_speed) { saveParams = true; } } else if (displaySelection == 4) // Font { #ifdef use_BIG_font oldByteValue = params.BigFontType; // speed from which we toggle to fuel/hour lcd_cls_print_P(PSTR("Font type")); // set value with left/right and set with middle do { if(LEFT_BUTTON_PRESSED && params.BigFontType!=0) params.BigFontType--; else if(RIGHT_BUTTON_PRESSED && params.BigFontType!=2) params.BigFontType++; sprintf_P(str, pctd, params.BigFontType); exitMenu = displaySecondLine(5, str); } while(!MIDDLE_BUTTON_PRESSED && !exitMenu); if (oldByteValue != params.BigFontType) { if(active_screen>=NBSCREEN) lcd_char_bignum(); saveParams = true; } #endif } } while (displaySelection != 0); // exit from this menu } else if (selection == 2) // Adjust { byte adjustSelection = 0; byte count = ARRAY_SIZE(adjustMenu); if (is_pid_supported(MAF_AIR_FLOW, 0)) { // Use the "Eng Displ" parameter (the last one) only when MAF_AIR_FLOW is not supported count--; } do { adjustSelection = menu_selection(adjustMenu, count); if (adjustSelection == 1) { lcd_cls_print_P(PSTR("Tank size (")); oldUIntValue = params.tank_size; fuelUnits = params.tank_size; // convert in gallon if requested #ifdef AllowChangeUnits if(params.use_metric) { lcd_print_P(PSTR("L)")); } else { fuelUnits = params.tank_size * 100L / 378L;//convertToGallons(params.tank_size); lcd_print_P(PSTR("G)")); } #else #ifdef UseSI lcd_print_P(PSTR("L)")); #endif #ifdef UseUS fuelUnits = params.tank_size * 100L / 378L;//convertToGallons(params.tank_size); lcd_print_P(PSTR("G)")); #endif #endif // set value with left/right and set with middle do { if(LEFT_BUTTON_PRESSED) { changed = true; fuelUnits--; } else if(RIGHT_BUTTON_PRESSED) { changed = true; fuelUnits++; } long_to_dec_str(fuelUnits, decs, 1); sprintf_P(str, PSTR("- %s + "), decs); exitMenu = displaySecondLine(4, str); } while(!MIDDLE_BUTTON_PRESSED && !exitMenu); if (changed) { #ifdef AllowChangeUnits if(!params.use_metric) fuelUnits = (fuelUnits * 378L) / 100L; //convertToLitres(fuelUnits); #else #ifdef UseSI #endif #ifdef UseUS fuelUnits = (fuelUnits * 378L) / 100L; //convertToLitres(fuelUnits); #endif #endif params.tank_size = fuelUnits; changed = false; } if (oldUIntValue != params.tank_size) { saveParams = true; } } else if (adjustSelection == 2) // cost { int lastButton = 0; lcd_cls_print_P(PSTR("Fuel Price (")); oldUIntValue = params.gas_price; fuelUnits = params.gas_price; // convert in gallons if requested #ifdef AllowChangeUnits if(params.use_metric) { lcd_print_P(PSTR("L)")); } else { // Convert unit price to litres for the cost per gallon. (ie $1 a litre = $3.785 per gallon) fuelUnits = (fuelUnits * 378L) / 100L; //convertToLitres(params.gas_price); lcd_print_P(PSTR("G)")); } #else #ifdef UseSI lcd_print_P(PSTR("L)")); #endif #ifdef UseUS // Convert unit price to litres for the cost per gallon. (ie $1 a litre = $3.785 per gallon) fuelUnits = (fuelUnits * 378L) / 100L; //convertToLitres(params.gas_price); lcd_print_P(PSTR("G)")); #endif #endif // set value with left/right and set with middle do { if(LEFT_BUTTON_PRESSED) { changed = true; lastButton--; if(lastButton >= 0) { lastButton = 0; fuelUnits--; } else if (lastButton < -3 && lastButton > -7) { fuelUnits-=2; } else if (lastButton <= -7) { fuelUnits-=10; } else { fuelUnits--; } } else if(RIGHT_BUTTON_PRESSED) { changed = true; lastButton++; if(lastButton <= 0) { lastButton = 0; fuelUnits++; } else if (lastButton > 3 && lastButton < 7) { fuelUnits+=2; } else if (lastButton >= 7) { fuelUnits+=10; } else { fuelUnits++; } } long_to_dec_str(fuelUnits, decs, fuelUnits > 999 ? 3 : 1); sprintf_P(str, gasPrice[fuelUnits > 999], decs); exitMenu = displaySecondLine(3, str); } while(!MIDDLE_BUTTON_PRESSED && !exitMenu); if (changed) { #ifdef AllowChangeUnits if(!params.use_metric) fuelUnits = (fuelUnits * 100L) / 378L; //convertToGallons(fuelUnits); #else #ifdef UseSI #endif #ifdef UseUS fuelUnits = (fuelUnits * 100L) / 378L; //convertToGallons(fuelUnits); #endif #endif params.gas_price = fuelUnits; changed = false; } if (oldUIntValue != params.gas_price) { saveParams = true; } } else if (adjustSelection == 3) { lcd_cls_print_P(PSTR("Fuel adjust")); oldByteValue = params.fuel_adjust; do { if(LEFT_BUTTON_PRESSED) params.fuel_adjust--; else if(RIGHT_BUTTON_PRESSED) params.fuel_adjust++; sprintf_P(str, pctdpctpct, params.fuel_adjust); exitMenu = displaySecondLine(4, str); } while(!MIDDLE_BUTTON_PRESSED && !exitMenu); if (oldByteValue != params.fuel_adjust) { saveParams = true; } } else if (adjustSelection == 4) { lcd_cls_print_P(PSTR("Speed adjust")); oldByteValue = params.speed_adjust; do { if(LEFT_BUTTON_PRESSED) params.speed_adjust--; else if(RIGHT_BUTTON_PRESSED) params.speed_adjust++; sprintf_P(str, pctdpctpct, params.speed_adjust); exitMenu = displaySecondLine(4, str); } while(!MIDDLE_BUTTON_PRESSED && !exitMenu); if (oldByteValue != params.fuel_adjust) { saveParams = true; } } else if (adjustSelection == 5) { lcd_cls_print_P(PSTR("Outing stop over")); oldByteValue = params.OutingStopOver; do { if(LEFT_BUTTON_PRESSED && params.OutingStopOver > 0) params.OutingStopOver--; else if(RIGHT_BUTTON_PRESSED && params.OutingStopOver < UCHAR_MAX) params.OutingStopOver++; sprintf_P(str, PSTR("- %2d Min + "), params.OutingStopOver * MINUTES_GRANULARITY); exitMenu = displaySecondLine(3, str); } while(!MIDDLE_BUTTON_PRESSED && !exitMenu); if (oldByteValue != params.OutingStopOver) { saveParams = true; } } else if (adjustSelection == 6) { lcd_cls_print_P(PSTR("Trip stop over")); oldByteValue = params.TripStopOver; do { unsigned long TripStopOver; // Allowable stop over time (in milliseconds). Exceeding time starts a new outing. if(LEFT_BUTTON_PRESSED && params.TripStopOver > 1) params.TripStopOver--; else if(RIGHT_BUTTON_PRESSED && params.TripStopOver < UCHAR_MAX) params.TripStopOver++; sprintf_P(str, PSTR("- %2d Hrs + "), params.TripStopOver); exitMenu = displaySecondLine(3, str); } while(!MIDDLE_BUTTON_PRESSED && !exitMenu); if (oldByteValue != params.TripStopOver) { saveParams = true; } } else if (adjustSelection == 7) // tank used params.trip[0].fuel { lcd_cls_print_P(PSTR("Tank used (")); oldULongValue = params.trip[0].fuel; tankUnits = params.trip[0].fuel / 1000 / 100; // converted from uL to dL #ifdef AllowChangeUnits // convert in gallon if requested if(params.use_metric) { lcd_print_P(PSTR("L)")); } else { tankUnits = params.trip[0].fuel * 100L / 378L; //convertToGallons(params.trip[0].fuel / 1000 / 100); // converted from uL to dL lcd_print_P(PSTR("G)")); } #else #ifdef UseSI lcd_print_P(PSTR("L)")); #endif #ifdef UseUS tankUnits = params.trip[0].fuel * 100L / 378L; //convertToGallons(params.trip[0].fuel / 1000 / 100); // converted from uL to dL lcd_print_P(PSTR("G)")); #endif #endif // set value with left/right and set with middle do { if(LEFT_BUTTON_PRESSED) { changed = true; tankUnits-=1; // decrement by 0.1L or G } else if(RIGHT_BUTTON_PRESSED) { changed = true; tankUnits+=1; // increment by 0.1L or G } long_to_dec_str(tankUnits, decs, 1); sprintf_P(str, PSTR("- %s + "), decs); exitMenu = displaySecondLine(4, str); } while(!MIDDLE_BUTTON_PRESSED && !exitMenu); if (changed) { #ifdef AllowChangeUnits if(!params.use_metric) tankUnits = tankUnits * 378L / 100L; //convertToLitres(tankUnits) * 1000 * 100; #else #ifdef UseSI #endif #ifdef UseUS tankUnits = tankUnits * 378L / 100L; //convertToLitres(tankUnits) * 1000 * 100; #endif #endif params.trip[0].fuel = tankUnits * 1000 * 100; changed = false; } if (oldULongValue != params.trip[0].fuel) { saveParams = true; } } else if (adjustSelection == 8) // tank distance params.trip[0].dist { lcd_cls_print_P(PSTR("Tank dist (")); oldULongValue = params.trip[0].dist; tankUnits = params.trip[0].dist / 100 / 1000; #ifdef AllowChangeUnits // convert in miles if requested if(params.use_metric) { lcd_print_P(PSTR("KM)")); } else { tankUnits = (tankUnits * 1000) / 1609; // converted from cm to km lcd_print_P(PSTR("M)")); } #else #ifdef UseSI lcd_print_P(PSTR("KM)")); #endif #ifdef UseUS tankUnits = (tankUnits * 1000) / 1609; // converted from cm to km lcd_print_P(PSTR("M)")); #endif #endif // set value with left/right and set with middle do { if(LEFT_BUTTON_PRESSED) { changed = true; tankUnits-=1; // decrement by 0.1km or mile } else if(RIGHT_BUTTON_PRESSED) { changed = true; tankUnits+=1; // increment by 0.1km or mile } long_to_dec_str(tankUnits, decs, 0); sprintf_P(str, PSTR("- %s + "), decs); exitMenu = displaySecondLine(4, str); } while(!MIDDLE_BUTTON_PRESSED && !exitMenu); if (changed) { #ifdef AllowChangeUnits if(!params.use_metric) tankUnits = tankUnits * 1609 / 1000; #else #ifdef UseSI #endif #ifdef UseUS tankUnits = tankUnits * 1609 / 1000; #endif #endif params.trip[0].dist = tankUnits * 100 * 1000; changed = false; } if (oldULongValue != params.trip[0].dist) { saveParams = true; } } else if (adjustSelection == 9) { lcd_cls_print_P(PSTR("Eng dplcmt (MAP)")); oldByteValue = params.eng_dis; // the following setting is for MAP only // engine displacement do { if(LEFT_BUTTON_PRESSED && params.eng_dis!=0) params.eng_dis--; else if(RIGHT_BUTTON_PRESSED && params.eng_dis!=100) params.eng_dis++; long_to_dec_str(params.eng_dis, decs, 1); sprintf_P(str, PSTR("- %sL + "), decs); exitMenu = displaySecondLine(4, str); } while(!MIDDLE_BUTTON_PRESSED && !exitMenu); if (oldByteValue != params.eng_dis) { saveParams = true; } } } while (adjustSelection != 0); } else if (selection == 3) // PIDs { // go through all the configurable items byte PIDSelection = 0; byte cur_screen; byte pid = 0; // Set PIDs required for the selected screen do { PIDSelection = menu_selection(PIDMenu, ARRAY_SIZE(PIDMenu)); if (PIDSelection != 0 && PIDSelection <= NBSCREEN + BIG_NBSCREEN) { cur_screen = PIDSelection - 1; for(byte current_PID=0; current_PID<LCD_PID_COUNT; current_PID++) { lcd.clear(); sprintf_P(str, PSTR("Scr %d PID %d"), cur_screen+1, current_PID+1); lcd.print(str); oldByteValue = pid = params.screen[cur_screen].PID[current_PID]; do { if(LEFT_BUTTON_PRESSED) { // while we do not find a supported PID, decrease while(!is_pid_supported(--pid, 1)); } else if(RIGHT_BUTTON_PRESSED) { // while we do not find a supported PID, increase while(!is_pid_supported(++pid, 1)); } char strpid[10]; strcpy_P(strpid, PID_Desc[remap_pid(pid)]); sprintf_P(str, PSTR("- %8s + "), strpid); exitMenu = displaySecondLine(2, str); } while(!MIDDLE_BUTTON_PRESSED && !exitMenu); // PID has changed so set it if (oldByteValue != pid) { params.screen[cur_screen].PID[current_PID]=pid; saveParams = true; } } } } while (PIDSelection != 0); } else if (selection == 4) { lcd_cls_print_P(PSTR("Clear DTC?")); byte ClearDTC = menu_select_yes_no(1); if (ClearDTC == 1) clear_mil_code(); } } while (selection != 0); if (saveParams) { // save params in EEPROM lcd_cls_print_P(PSTR("Saving config")); lcd.setCursor(0,1); lcd_print_P(PSTR("Please wait...")); params_save(); } lcd.clear(); //Clean up display (important if displaying with "BigNum" } // This helps reduce code size by containing repeated functionality. boolean displaySecondLine(byte position, char * str) { lcd.setCursor(position,1); lcd.print(str); return delay_reset_button(); } // Reworked a little to allow all trip types to be reset from one function. void trip_reset(byte ctrip, boolean ask) { boolean reset = true; char str[STRLEN]; // Display the intent lcd.clear(); sprintf_P(str, PSTR("Zero %s data"), (char*)pgm_read_word(&(tripNames[ctrip]))); lcd.print(str); if(ask) { reset=menu_select_yes_no(0); // init to "no" } if(reset) { #ifdef logTripSummary logSummary(); #endif params.trip[ctrip].dist=0L; params.trip[ctrip].fuel=0L; params.trip[ctrip].waste=0L; params.tripmax[ctrip].maxspeed = 0; params.tripmax[ctrip].maxrpm = 0; params.tripmax[ctrip].maxmaf = 0; // Increase trip counter (if 255 then 0) params.tripmax[ctrip].counter++; // Reset lower level counts (if TANK then reset TRIP and OUTING; if TRIP then reset OUTING) if (ctrip < TRIP) params.tripmax[TRIP].counter = 0; if (ctrip < OUTING) params.tripmax[OUTING].counter = 0; params.tripmax[ctrip].timedriving = 0L; params.tripmax[ctrip].timeidling = 0L; // memset is better, should be tested some time // memset(¶ms.tripmax[ctrip], 0, sizeof(trip_max)); if (ctrip == OUTING && ask) { // Reset the start time to now too engine_on = millis(); } } if (!ask) { delay(750); // let user see (if they are paying attention) } } /* unsigned int convertToGallons(unsigned int litres) { return (unsigned int) ( ((unsigned long)litres*100L) / 378L ); } */ /* unsigned int convertToLitres(unsigned int gallons) { return (unsigned int) ( ((unsigned long)gallons*378L) / 100L ); } */ int convertToFarenheit(int celsius) { return ((celsius * 9) / 5) + 320; } void test_buttons(void) { // if any button pressed, wait for other buttons if any if (buttonState != buttonsUp) delay(KEY_WAIT); // middle + left + right = mil check if (MIDDLE_BUTTON_PRESSED && LEFT_BUTTON_PRESSED && RIGHT_BUTTON_PRESSED) { needBacklight(true); check_mil_code(false); } // middle + left = tank reset else if (MIDDLE_BUTTON_PRESSED && LEFT_BUTTON_PRESSED) { needBacklight(true); trip_reset(TANK, true); } // middle + right = trip reset else if(MIDDLE_BUTTON_PRESSED && RIGHT_BUTTON_PRESSED) { // Added choice to reset OUTING trip also. We could merge TANK here too, and then just use the menu selection // to select the trip type to reset (maybe ask confirmation or not, since the menu has an exit). needBacklight(true); trip_reset(TRIP, true); trip_reset(OUTING, true); } // left + right = flash pid info else if(LEFT_BUTTON_PRESSED && RIGHT_BUTTON_PRESSED) { display_PID_names(); } // left is cycle through active screen else if(LEFT_BUTTON_PRESSED) { #ifdef use_BIG_font active_screen = (active_screen+1) % (NBSCREEN+BIG_NBSCREEN); #else active_screen = (active_screen+1) % (NBSCREEN); #endif if(active_screen<NBSCREEN) { lcd.clear(); lcd_char_init(); display_PID_names(); } else { lcd.clear(); #ifdef use_BIG_font lcd_char_bignum(); #endif } } // right is cycle through brightness settings else if(RIGHT_BUTTON_PRESSED) { char str[STRLEN] = {0}; brightnessIdx = (brightnessIdx + 1) % brightnessLength; analogWrite(BrightnessPin, brightness[brightnessIdx]); lcd_cls_print_P(PSTR(" LCD backlight")); lcd.setCursor(6,1); sprintf_P(str,PSTR("%d / %d"),brightnessIdx + 1,brightnessLength); lcd.print(str); delay(500); } // middle is go into menu else if(MIDDLE_BUTTON_PRESSED) { needBacklight(true); config_menu(); } // reset buttons state if (buttonState!=buttonsUp) { #ifdef carAlarmScreen refreshAlarmScreen = true; #endif delay_reset_button(); needBacklight(false); } } void display_PID_names(void) { needBacklight(true); lcd.clear(); // Lets flash up the description of the PID's we use when screen changes byte count = 0; for (byte row = 0; row < LCD_ROWS; row++) { for (byte col = 0; col == 0 || col == LCD_SPLIT; col+=LCD_SPLIT) { lcd.setCursor(col,row); lcd_print_P(PID_Desc[remap_pid(params.screen[active_screen].PID[count++])]); } } delay(750); // give user some time to see new PID titles } void needBacklight(boolean On) { //only if ECU or engine are off do we need the backlight. #ifdef useECUState if (!ECUconnection) #else if (!engine_started) #endif { // Assume backlight is normally off, so set according to input On analogWrite(BrightnessPin, brightness[On ? brightnessIdx : 0]); } } /* * Initialization */ void setup() // run once, when the sketch starts { #ifndef ELM boolean success; // init pinouts pinMode(K_OUT, OUTPUT); pinMode(K_IN, INPUT); #ifdef useL_Line pinMode(L_OUT, OUTPUT); #endif #endif // buttons init pinMode(lbuttonPin, INPUT); pinMode(mbuttonPin, INPUT); pinMode(rbuttonPin, INPUT); // "turn on" the internal pullup resistors digitalWrite(lbuttonPin, HIGH); digitalWrite(mbuttonPin, HIGH); digitalWrite(rbuttonPin, HIGH); // low level interrupt enable stuff // interrupt 1 for the 3 buttons PCMSK1 |= (1 << PCINT11) | (1 << PCINT12) | (1 << PCINT13); PCICR |= (1 << PCIE1); // load parameters params_load(); // if something is wrong, default parms are used // LCD pin init #ifndef skip_ISO_Init analogWrite(BrightnessPin,brightness[brightnessIdx]); #endif analogWrite(ContrastPin, params.contrast); lcd.begin(LCD_COLS, LCD_ROWS); lcd_char_init(); // Temperature sensors init #ifdef UseInsideTemperatureSensor pinMode(InsideTemperaturePin, INPUT); #endif #ifdef UseOutsideTemperatureSensor pinMode(OutsideTemperaturePin, INPUT); #endif // Voltage sensor init #ifdef BatteryVoltageSensor pinMode(BatteryVoltagePin, INPUT); #endif // Buzzer init #ifdef UseBuzzer pinMode(BuzzerPin, OUTPUT); digitalWrite(BuzzerPin, HIGH); #endif engine_off = engine_on = millis(); lcd_cls_print_P(PSTR("OBDuino32k v198")); #if !defined( ELM ) && !defined(skip_ISO_Init) do // init loop { lcd.setCursor(2,1); #ifdef ISO_9141 lcd_print_P(PSTR("ISO9141 Init")); #elif defined ISO_14230_fast lcd_print_P(PSTR("ISO14230 Fast")); #elif defined ISO_14230_slow lcd_print_P(PSTR("ISO14230 Slow")); #endif #ifdef DEBUG // In debug mode we need to skip init. success=true; #else ISO_InitStep = 0; do { #ifdef DEBUGOutput LastISO_InitStep = ISO_InitStep; #endif iso_init(); } while (ISO_InitStep != 0); success = ECUconnection; #ifdef useECUState oldECUconnection != ECUconnection; // force 'turn on' stuff in main loop #endif #endif lcd.setCursor(2,1); char str[STRLEN] = {0}; if (success) sprintf_P(str, PSTR("Successful! ")); else { #ifdef DEBUGOutput if (LastISO_InitStep != 9) sprintf_P(str, PSTR("Failed! %d "), LastISO_InitStep); else { sprintf_P(str, PSTR("F!%X%d %X%d %X %X%d "), LastReceived1, LastReceived1OK, LastReceived2, LastReceived2OK, LastSend1, LastReceived3, LastReceived3OK); lcd.setCursor(0, 1); } #else sprintf_P(str, PSTR("Failed! ")); #endif } lcd.print(str); delay(1000); lcd.setCursor(0, 1); sprintf_P(str, PSTR(" ")); lcd.print(str); } while(!success); // end init loop #else #ifdef ELM elm_init(); #endif #endif #ifdef carAlarmScreen refreshAlarmScreen = true; #endif #ifndef skip_ISO_Init // check supported PIDs check_supported_pids(); #ifndef DisableDTCReadOnStart // check if we have MIL code check_mil_code(true); #endif lcd.clear(); old_time=millis(); // epoch getpid_time=old_time; #else //ISO_InitStep = 0; //Variable already initialized in define section, no need of additional init ECUconnection = oldECUconnection = false; engine_started = has_rpm = 0; #endif } static void DisplayLCDPIDS(char *str, char *str2) { if (active_screen<NBSCREEN) for(byte current_PID=0; current_PID<LCD_PID_COUNT; current_PID++) display(current_PID, params.screen[active_screen].PID[current_PID]); #ifdef use_BIG_font else if (active_screen==NBSCREEN) { get_pid_internal(str, params.screen[active_screen].PID[0]); bigNum(str, ""); } else { //params.screen[active_screen].PID[0] if (params.BigFontType < 2) { get_pid_internal(str2, params.screen[active_screen].PID[1]); str2[5] ='\0'; get_pid_internal(str, params.screen[active_screen].PID[0]); bigNum(str, str2); } else { get_pid_internal(str, params.screen[active_screen].PID[0]); bigNum(str, ""); } } #endif } /* * Main loop */ void loop() // run over and over again { char str[STRLEN]; char str2[STRLEN]; #ifdef useECUState #ifdef DEBUG ECUconnection = true; has_rpm = true; #else ECUconnection = verifyECUAlive(); #endif if (oldECUconnection != ECUconnection) { if (ECUconnection) { unsigned long nowOn = millis(); unsigned long engineOffPeriod = calcTimeDiff(engine_off, nowOn); if (has_rpm > 0) analogWrite(BrightnessPin, brightness[brightnessIdx]); if (engineOffPeriod > (params.OutingStopOver * MINUTES_GRANULARITY * MILLIS_PER_MINUTE)) { trip_reset(OUTING, false); // zero instant cons clear_icons_tvss(); clear_icons_tmaf(); engine_on = nowOn; } else { // combine last trip time to this one! Not including the stop over time engine_on = nowOn - calcTimeDiff(engine_on, engine_off); } if (engineOffPeriod > (params.TripStopOver * MILLIS_PER_HOUR)) { trip_reset(TRIP, false); } } else // Car is off { #ifdef do_ISO_Reinit ISO_InitStep = 0; #endif save_params_and_display(); //clear screen after turn off lcd.clear(); #ifdef carAlarmScreen refreshAlarmScreen = true; #endif } oldECUconnection = ECUconnection; } // If engine was on, and RPM is 0 - save trip data and turn engine off if (engine_started == 1 && has_rpm == 0) { engine_started = 0; #ifdef SaveTripDataAfterEngineTurnOff save_params_and_display(); //Turn the Backlight off analogWrite(BrightnessPin, brightness[0]); #endif } if (ECUconnection) { // If car was off, backlight was turned off, we need to turn it back on if (engine_started == 0 && has_rpm != 0) { engine_started = 1; analogWrite(BrightnessPin, brightness[brightnessIdx]); #ifdef carAlarmScreen lcd.clear(); // Clear away any debris from Car Alarm Screen #endif } // this read and assign vss and maf and accumulate trip data accu_trip(); // display on LCD DisplayLCDPIDS(str, str2); } else { #ifdef carAlarmScreen // ECU is off so print ready screen instead of PIDS while we wait for ECU action if (ISO_InitStep < 2) // Print to LCD if idle only displayAlarmScreen(); #else // for some reason the display on LCD if (ISO_InitStep < 2) // Print to LCD if idle only DisplayLCDPIDS(str, str2); #endif #ifdef do_ISO_Reinit iso_init(); #endif } #else // test if engine is started has_rpm = (get_pid(ENGINE_RPM, str, &engineRPM) && engineRPM > 0) ? 1 : 0; if (engine_started==0 && has_rpm!=0) { unsigned long nowOn = millis(); unsigned long engineOffPeriod = calcTimeDiff(engine_off, nowOn); engine_started=1; param_saved=0; analogWrite(BrightnessPin, brightness[brightnessIdx]); if (engineOffPeriod > (params.OutingStopOver * MINUTES_GRANULARITY * MILLIS_PER_MINUTE)) { //Reset the current outing trip from last trip trip_reset(OUTING, false); // zero instant cons clear_icons_tvss(); clear_icons_tmaf(); engine_on = nowOn; //Reset the time at which the car starts at } else { // combine last trip time to this one! Not including the stop over time engine_on = nowOn - calcTimeDiff(engine_on, engine_off); } if (engineOffPeriod > (params.TripStopOver * MILLIS_PER_HOUR)) { trip_reset(TRIP, false); } } // if engine was started but RPM is now 0 // save param only once, by flopping param_saved if (has_rpm==0 && param_saved==0 && engine_started!=0) { save_params_and_display(); #ifdef carAlarmScreen refreshAlarmScreen = true; #endif } if (engine_started) { // this read and assign vss and maf and accumulate trip data accu_trip(); // display on LCD DisplayLCDPIDS(str, str2); } else { #ifdef carAlarmScreen displayAlarmScreen(); #else DisplayLCDPIDS(str, str2); #endif } #endif // test buttons test_buttons(); } // Calculate the time difference, and account for roll over too unsigned long calcTimeDiff(unsigned long start, unsigned long end) { /* if (start < end) { return end - start; } else // roll over { return ULONG_MAX - start + end; } */ // inspired by http://www.arduino.cc/playground/Code/TimingRollover saves 200bytes return (long)(end - start); } #ifdef useECUState boolean verifyECUAlive(void) { #ifdef ELM char cmd_str[6]; // to send to ELM char str[STRLEN]; // to receive from ELM sprintf_P(cmd_str, PSTR("01%02X\r"), ENGINE_RPM); elm_write(cmd_str); elm_read(str, STRLEN); return elm_check_response(cmd_str, str) == 0; #else //ISO #ifdef do_ISO_Reinit if (!ECUconnection) // only check for off, finding active ECU is handled by successful reiniting { return ECUconnection; } #endif // Send command to ECU, if it is active, we will get data back. // Set RPM to 1 if ECU active and RPM above 0, otherwise zero. char str[STRLEN]; boolean connected = get_pid(ENGINE_RPM, str, &engineRPM); has_rpm = (connected && engineRPM > 0) ? 1 : 0; #ifdef DisconnectECUIfRPMIsZero connected = has_rpm; #endif return connected; #endif } #endif #ifdef carAlarmScreen // This screen will display a fake security heading, // then emulate an array of LED's blinking in Knight Rider style. // This could be modified to blink a real LED (or maybe a short array depending on available pins) void displayAlarmScreen(void) { static byte pingPosition; static boolean pingDirection; static long nextMoveTime; const long pingTimeOut = 1000; const byte lastLCDChar = 15; if (refreshAlarmScreen) { pingPosition = 0; pingDirection = 0; lcd_cls_print_P(PSTR("OBDuino Security")); lcd.setCursor(pingPosition,1); lcd.write('*'); refreshAlarmScreen = false; nextMoveTime = millis() + pingTimeOut; } else if (millis() > nextMoveTime) { lcd.setCursor(pingPosition,1); lcd.write(' '); if(pingPosition == 0 || pingPosition == lastLCDChar) { // Change direction pingDirection = !pingDirection; } // Move the character if(pingDirection) { pingPosition+= 3; } else { pingPosition-=3; } lcd.setCursor(pingPosition,1); lcd.write('*'); nextMoveTime = millis() + pingTimeOut; } } #endif /* * Memory related functions */ // we have 512 bytes of EEPROM on the 168P, more than enough void params_save(void) { uint16_t crc; byte *p; // CRC will go at the end crc=0; p=(byte*)¶ms; for(byte i=0; i<sizeof(params_t); i++) crc+=p[i]; // start at address 0 eeprom_write_block((const void*)¶ms, (void*)0, sizeof(params_t)); // write CRC after params struct eeprom_write_word((uint16_t*)sizeof(params_t), crc); #ifdef AutoSave old_time_params = millis(); #endif } void params_load(void) { params_t params_tmp; uint16_t crc, crc_calc; byte *p; #ifdef AutoSave old_time_params = millis(); #endif // read params eeprom_read_block((void*)¶ms_tmp, (void*)0, sizeof(params_t)); // read crc crc=eeprom_read_word((const uint16_t*)sizeof(params_t)); // calculate crc from read stuff crc_calc=0; p=(byte*)¶ms_tmp; for(byte i=0; i<sizeof(params_t); i++) crc_calc+=p[i]; // compare CRC if(crc==crc_calc) // good, copy read params to params params=params_tmp; #ifdef AllowChangeUnits #else #ifdef UseSI params.use_metric = 1; #endif #ifdef UseUS params.use_metric = 0; #endif #endif } #ifdef DEBUG // how can this takes 578 bytes!! // this function will return the number of bytes currently free in RAM // there is about 670 bytes free in memory when OBDuino is running extern int __bss_end; extern int *__brkval; int memoryTest(void) { int free_memory; if((int)__brkval == 0) free_memory = ((int)&free_memory) - ((int)&__bss_end); else free_memory = ((int)&free_memory) - ((int)__brkval); return free_memory; } #endif /* * LCD functions */ void lcd_print_P(char *string) { char c; while( (c = pgm_read_byte(string++)) ) lcd.write(c); } void lcd_cls_print_P(char *string) { lcd.clear(); lcd_print_P(string); } void lcd_char_init() { //creating the custom fonts (8 char max) // char 0 is not used // 1&2 is the L/100 datagram in 2 chars only // 3&4 is the km/h datagram in 2 chars only // 5 is the ? char (degree) // 6&7 is the mi/g char #define NB_CHAR 7 // set cg ram to address 0x08 (B001000) to skip the // first 8 rows as we do not use char 0 lcd.command(B01001000); static prog_uchar chars[] PROGMEM ={ B10000,B00000,B10000,B00010,B00111,B11111,B00010, B10000,B00000,B10100,B00100,B00101,B10101,B00100, B11001,B00000,B11000,B01000,B00111,B10101,B01000, B00010,B00000,B10100,B10000,B00000,B00000,B10000, B00100,B00000,B00000,B00100,B00000,B00100,B00111, B01001,B11011,B11111,B00100,B00000,B00000,B00100, B00001,B11011,B10101,B00111,B00000,B00100,B00101, B00001,B11011,B10101,B00101,B00000,B00100,B00111, }; for(byte x=0;x<NB_CHAR;x++) for(byte y=0;y<8;y++) // 8 rows lcd.write(pgm_read_byte(&chars[y*NB_CHAR+x])); //write the character data to the character generator ram } #ifdef use_BIG_font void lcd_char_bignum() { //creating the custom fonts: lcd.command(B01001000); // set cgram #define BIGFontFontCount 3 #define BIGFontSymbolCount 8 static prog_uchar chars[BIGFontFontCount*BIGFontSymbolCount*8] PROGMEM = { //2x2_alpha B00000, B11111, B11000, B00011, B11111, B11111, B11111, B11111, B00000, B11111, B11000, B00011, B11111, B11111, B11111, B11111, B00000, B00011, B11000, B00011, B11000, B00011, B00000, B00000, B00000, B00011, B11000, B00011, B11000, B00011, B00000, B00000, B00000, B00011, B11000, B00011, B11000, B00011, B00000, B00000, B00000, B00011, B11000, B00011, B11000, B00011, B00000, B00000, B11111, B00011, B11111, B11111, B11111, B11111, B00000, B11111, B11111, B00011, B11111, B11111, B11111, B11111, B00000, B11111, //2x2_beta B11111, B11111, B11000, B00011, B11111, B11111, B11111, B00000, B11111, B11111, B11000, B00011, B11111, B11111, B11111, B00000, B11000, B00011, B11000, B00011, B11000, B00011, B00000, B00000, B11000, B00011, B11000, B00011, B11000, B00011, B00000, B00000, B11000, B00011, B11000, B00011, B11000, B00011, B00000, B00000, B11000, B00011, B11000, B00011, B11000, B00011, B00000, B00000, B11000, B00011, B11111, B11111, B11111, B11111, B00000, B11111, B11000, B00011, B11111, B11111, B11111, B11111, B00000, B11111, //2x3 B11111, B00000, B11111, B11111, B00000, B00000, B00000, B00000, B11111, B00000, B11111, B11111, B00000, B00000, B00000, B00000, B00000, B00000, B00000, B11111, B00000, B00000, B00000, B00000, B00000, B00000, B00000, B11111, B00000, B00000, B00000, B00000, B00000, B00000, B00000, B11111, B00000, B00000, B00000, B00000, B00000, B00000, B00000, B11111, B01110, B00000, B00000, B00000, B00000, B11111, B11111, B11111, B01110, B00000, B00000, B00000, B00000, B11111, B11111, B11111, B01110, B00000, B00000, B00000 }; for (byte x = 0; x < BIGFontSymbolCount; x++) for (byte y = 0; y < 8; y++) lcd.write(pgm_read_byte(&chars[params.BigFontType*BIGFontSymbolCount*8 + y*BIGFontSymbolCount + x])); //write the character data to the character generator ram } #endif char fBuff[7];//used by format char *format(unsigned long num) { byte dp = 3; while (num > 999999) { num /= 10; dp++; if (dp == 5) break; // We'll lose the top numbers like an odometer } if (dp == 5) dp = 99; // We don't need a decimal point here. // Round off the non-printed value. if ((num % 10) > 4) num += 10; num /= 10; byte x = 6; while (x > 0) { x--; if (x == dp) { //time to poke in the decimal point?{ fBuff[x] = '.'; } else { fBuff[x] = '0' + (num % 10);//poke the ascii character for the digit. num /= 10; } } fBuff[6] = 0; return fBuff; } #ifdef use_BIG_font void bigNum(char *txt, char *txt1) { static prog_char bignumchars1[40*BIGFontFontCount] PROGMEM = { 5, 2, 0, 0, 2, 32, 0, 0, 8, 6, 0, 0, 7, 6, 0, 0, 3, 4, 0, 0, 5, 8, 0, 0, 5, 8, 0, 0, 7, 2, 0, 0, 5, 6, 0, 0, 5, 6, 0, 0, 1, 2, 0, 0, 2, 32, 0, 0, 7, 6, 0, 0, 7, 6, 0, 0, 3, 4, 0, 0, 5, 7, 0, 0, 1, 7, 0, 0, 7, 2, 0, 0, 5, 6, 0, 0, 5, 6, 0, 0, 4, 1, 4, 0, 1, 4, 32, 0, 3, 3, 4, 0, 1, 3, 4, 0, 4, 2, 4, 0, 4, 3, 3, 0, 4, 3, 3, 0, 1, 1, 4, 0, 4, 3, 4, 0, 4, 3, 4, 0 }; static prog_char bignumchars2[40*BIGFontFontCount] PROGMEM = { 3, 4, 0, 0, 4, 1, 0, 0, 3, 1, 0, 0, 1, 4, 0, 0, 32, 2, 0, 0, 1, 4, 0, 0, 3, 4, 0, 0, 32, 2, 0, 0, 3, 4, 0, 0, 1, 4, 0, 0, 3, 4, 0, 0, 4, 8, 0, 0, 5, 8, 0, 0, 8, 4, 0, 0, 32, 2, 0, 0, 8, 6, 0, 0, 5, 6, 0, 0, 32, 2, 0, 0, 3, 4, 0, 0, 8, 4, 0, 0, 4, 2, 4, 0, 2, 4, 2, 0, 4, 2, 2, 0, 2, 2, 4, 0, 32, 32, 4, 0, 2, 2, 4, 0, 4, 2, 4, 0, 32, 4, 32, 0, 4, 2, 4, 0, 2, 2, 4, 0 }; //byte DecimalPointSymbols[BIGFontFontCount] = {5, '.', '.'}; //DecimalPointSymbols[params.BigFontType] byte CharPos = 40*params.BigFontType; for (byte line = 0; line < 2; line++) { lcd.setCursor(0, line); byte pos = 0; byte digitcount = 0; while (digitcount < 4) { digitcount++; if (txt[pos] >= '0' && txt[pos] <= '9') { byte address = CharPos + (txt[pos] - '0') * 4; lcd_print_P(line==0?&bignumchars1[address]:&bignumchars2[address]); char mark = ' '; if (txt[pos+1] == '.' || txt[pos+1] == ',') { if (line == 1) mark = txt[pos+1]; pos++; } lcd.write(mark); pos++; } else for (byte i=0; i<3; i++) lcd.write(' '); } byte ScreenPos = 12; // print units on first row if (line == 0) { // need convert L/KM, MPG, C or F to normal symbols pos++; //skip space while (pos < 8 && txt[pos] != 0) { switch (txt[pos]) { case 1 : lcd.write('L'); ScreenPos+=1; break; case 2 : lcd.write('/'); lcd.write('k'); lcd.write('m'); ScreenPos+=3; break; case 3 : lcd.write('k'); lcd.write('m'); ScreenPos+=2; break; case 4 : lcd.write('/'); lcd.write('h'); ScreenPos+=2; break; case 5 : break; case 6 : lcd.write('M'); ScreenPos+=1; break; case 7 : lcd.write('P'); lcd.write('G'); ScreenPos+=2; break; default : lcd.write(txt[pos]); ScreenPos+=1; break; } pos++; } } else { // print any text on second row lcd.print(txt1); } // clear end of line for (byte i=ScreenPos; i<LCD_COLS; i++) lcd.write(' '); } } #endif /* Adj % 0 1 2 3 4 4 5 6 7 8 <==star count 1% 91% 92% 93% 94% 95% 105% 106% 107% 108% 109% 2% 88% 89% 91% 93% 95% 105% 107% 109% 111% 114% 3% 84% 87% 89% 92% 95% 105% 108% 111% 115% 118% 4% 81% 84% 88% 91% 95% 105% 109% 114% 118% 123% 5% 77% 81% 86% 90% 95% 105% 110% 116% 122% 128% 6% 74% 79% 84% 89% 95% 105% 111% 118% 125% 133% 7% 71% 76% 82% 88% 95% 105% 112% 120% 129% 138% 8% 68% 74% 80% 87% 95% 105% 113% 122% 132% 143% 9% 65% 72% 79% 86% 95% 105% 114% 125% 136% 148% 10% 62% 69% 77% 86% 95% 105% 116% 127% 140% 154% 11% 60% 67% 75% 85% 95% 105% 117% 129% 144% 159% 12% 57% 65% 74% 84% 95% 105% 118% 132% 148% 165% 13% 54% 63% 72% 83% 95% 105% 119% 134% 152% 171% */ #define PERCENTAGE_RANGE 108 //108 = 8% void eco_visual(char *retbuf) { //enable our varriables unsigned long tank_cons, outing_cons; unsigned long tfuel, tdist; int stars; tfuel = params.trip[OUTING].fuel; tdist = params.trip[OUTING].dist; if(tdist > 100 && tfuel!=0) {//Make sure no devisions by Zero. outing_cons = tfuel / (tdist / 1000); //our current trip since engine start tfuel = params.trip[TANK].fuel; tdist = params.trip[TANK].dist; tank_cons = tfuel / (tdist / 1000); //our results for the current tank of gas } else { //give some dummy numbers to avoid devide by zero numbers tank_cons = 100; outing_cons = 101; } //lets start off in the middle stars = 3; // 3 = Average. if ( outing_cons < tank_cons ) { //doing good :) outing_cons = (outing_cons*105) / 100; //Check if within 5% of TANK for Average result //Loop to check how much better we are doing //Each time the smaller number will be increased by a set percentage //in order to add or subtract from our star count. while(outing_cons < tank_cons && stars < 7) { outing_cons = (outing_cons*PERCENTAGE_RANGE) / 100; stars++; } outing_cons=0; } else if (outing_cons > tank_cons) { //doing bad... so far... tank_cons = (tank_cons*105) / 100; //Check if within 5% of TANK for Average result while(outing_cons > tank_cons && stars > 0) { //Loop to check how much worse we are doing tank_cons = (tank_cons*PERCENTAGE_RANGE) / 100; stars--; } } //else they are equal, do nothing. //Now we have our star count, use it as an index to access the text sprintf_P(retbuf, PSTR("%s"), (char*)pgm_read_word(&(econ_Visual[stars]))); } //get_trip_time will return trip driving or idling void get_trip_time(char *retbuf, byte trip, byte time) { unsigned long run_time = params.tripmax[trip].timedriving; if (time == 1) run_time = params.tripmax[trip].timeidling; int hours, minutes, seconds; //to store the time hours = (run_time / MILLIS_PER_HOUR); minutes = (run_time % MILLIS_PER_HOUR) / MILLIS_PER_MINUTE; seconds = (run_time % MILLIS_PER_MINUTE) / MILLIS_PER_SECOND; //Now we have our varriables parsed, lets display them sprintf_P(retbuf, PSTR("%d:%02d:%02d"), hours, minutes, seconds); } //get_engine_on_time will return the time since the engine has started void get_engine_on_time(char *retbuf) { unsigned long run_time; int hours, minutes, seconds; //to store the time #ifdef useECUState if (ECUconnection) {//update with current time, if the car is running #else if(has_rpm) {//update with current time, if the car is running #endif run_time = calcTimeDiff(engine_on, millis()); //We now have the number of ms } else { //car is not running. Display final time when stopped. run_time = calcTimeDiff(engine_on, engine_off); } //Lets display the running time //hh:mm:ss hours = run_time / MILLIS_PER_HOUR; minutes = (run_time % MILLIS_PER_HOUR) / MILLIS_PER_MINUTE; seconds = (run_time % MILLIS_PER_MINUTE) / MILLIS_PER_SECOND; //Now we have our varriables parsed, lets display them sprintf_P(retbuf, PSTR("%d:%02d:%02d"), hours, minutes, seconds); } void get_cost(char *retbuf, byte ctrip) { unsigned long cents; unsigned long fuel; char decs[16]; params.gas_price; // x/1000 = dollars fuel = params.trip[ctrip].fuel / 10000; //cL cents = fuel * params.gas_price / 1000; //now have $$$$cc long_to_dec_str(cents, decs, 2); sprintf_P(retbuf, PSTR(CurrencyPrintString), decs); } void save_params_and_display(void) { engine_off = millis(); //record the time the engine was shut off params_save(); param_saved = 1; engine_started = 0; lcd_cls_print_P(PSTR("TRIPS SAVED!")); //Lets Display how much fuel for the tank we wasted. char str[STRLEN] = {0}; lcd.setCursor(0,1); lcd_print_P(PSTR("Wasted:")); lcd.setCursor(LCD_SPLIT,1); get_waste(str,TANK); lcd.print(str); delay(2000); //Turn the Backlight off needBacklight(false); } // SD card functions #ifdef useSDCard void logbuffer(void) { int length = strlen(logString); if (length >= logBufferSize - 60) { FileLogger::append("data.log", (byte*)logString, length); logString[0] = 0; } } // driving time, engine on time etc. // limit time intervals (maybe) void logpid(byte pid, char *str, long *value) { char engine_time[9]; get_engine_on_time(engine_time); #ifdef logTypeVerbose sprintf_P(&logString[strlen(logString)], PSTR("%d\t%d\t%d\t%s\t%d\t%ld\t%s\r\n"), params.tripmax[TANK].counter, params.tripmax[TRIP].counter, params.tripmax[OUTING].counter, engine_time, pid, *value, str); #endif #ifdef logTypeSystem sprintf_P(&logString[strlen(logString)], PSTR("%02X%02X%02X%02X%08lX\r\n"), params.tripmax[TANK].counter, params.tripmax[TRIP].counter, params.tripmax[OUTING].counter, pid, *value); #endif logbuffer(); } // log data collection every accu_trip() cycle void logdata(byte throttle_pos) { char engine_time[9]; get_engine_on_time(engine_time); sprintf_P(&logString[strlen(logString)], PSTR("%02X%02X%02X\t%s\t%ld\t%ld\t%ld\t%d\r\n"), params.tripmax[TANK].counter, params.tripmax[TRIP].counter, params.tripmax[OUTING].counter, engine_time, vss, engineRPM, maf, throttle_pos); logbuffer(); } // log trip summary #ifdef logTripSummary void logSummary(void) { #ifdef logTypeVerbose // write params_t structure in verbose mode to SD card (300bytes of code) char string[60]; for (byte i=OUTING; i<NBTRIP; i++) { sprintf_P(string, PSTR("%02X%02X%02X\t%ld\t%ld\t%ld\t%ud\t%ud\t%ud\t%ld\t%ld\t\r\n"), params.tripmax[TANK].counter, params.tripmax[TRIP].counter, params.tripmax[OUTING].counter, params.trip[i].dist, params.trip[i].fuel, params.trip[i].waste, params.tripmax[i].maxspeed, params.tripmax[i].maxrpm, params.tripmax[i].maxmaf, params.tripmax[i].timedriving, params.tripmax[i].timeidling ); FileLogger::append("summary.log", (byte*)string, strlen(string)); } #endif #ifdef logTypeSystem // write params_t structure dump to SD card (30bytes of code) FileLogger::append("summary.log", (byte*)¶ms, sizeof(params_t)); /* char string[sizeof(params_t)+1]; memcpy(string, ¶ms, sizeof(params_t)); string[sizeof(params_t)] = 0; FileLogger::append("summary.log", (byte*)string, strlen(string)); */ #endif } #endif //logTripSummary #endif //useSDCard #ifdef UseBuzzer // Time in 10th of ms (1 = 10ms, 12 = 120ms) // If negative - delay only void Buzzer(char Time) { byte Delay = Time>0?Time:(-1)*Time; if (Time>0) digitalWrite(BuzzerPin, LOW); delay(Delay*10); digitalWrite(BuzzerPin, HIGH); } #endif
Для начала нужно раскомментировать нужные строки из 290, 291, 292.
Номера пинов укзаны в строках 470, 475.
Спасибо понял.А датчик напряжения какой ставить? строки 295-298.
Спасибо понял.А датчик напряжения какой ставить? строки 295-298.
Ну поищите же по коду "BatteryVoltageSensor" там даже "схема" есть. (строка 2310). А вобще такие вещи надо у авторов узнавать, из первоисточника так сказать. Не голый скетч тащить, а с описанием - для чего он нужен, с чем работает и т.д. А то дальше будет - этим не компилируется, в это не заливается, это не работает...
Вот схема автора. Я так понял из скетча, или буззер или один датчик температуры.
Как то так, да. Ножки кончились. Поэтому автор и сделал датчики опциональными на трёх оставшихся ногах:
A0 - сигнал с делителя напряжения для контроля батареи
А1 - буззер или первый датчик температуры
А2 - второй датчик температуры.
Или по последней схемке это 23, 24, 25.
А если LCD на i2c переделать, ещё 4 ноги освободится.
А если LCD на i2c переделать, ещё 4 ноги освободится.
Привет всем.Спасибо.А часы можно как то в скетч впихнуть,чтобы при подаче напряжения вначале отображалось время. Никто не поможет.У меня с программированием туго.
Помогите пожалуйста.При прошивке через Arduino 1.8.5 пишет
D:\Новая папка\obduino32\obduino32.ino:365:26: fatal error: LiquidCrystal.: No such file or directory compilation terminated.exit status 1 Ошибка компиляции для платы Arduino Nano.
Menu -> Sketch -> Include Library -> Manage Libraries -> LiquidCrystal
uino32:6 и Спасибо.Библиотеку обновил.Появились следующие ошибки.Автор прошивал Atmega-328 ардуино-0023. В этой старой версии скетч
проверяется без проблем.Но не могу прошить свою ардуино при выборе программатора пишет avrdude:usbdev_open(): did not find any
USB device "usb"
:
Arduino: выделяется желтым. static prog_char bignumchars2[40 * BIGFontFontCount] PROGMEM = {
Arduino: 1.8.5 (Windows Vista), Плата:"Arduino Nano, ATmega328P"
o bduino32:678: error: 'prog_char' does not name a type
obduino32:806: error: 'prog_char' does not name a type
А где в схеме часы ? Нет их там !
Это проблема, конечно. Если замена prog_char на const char не поможет, то тут нужна работа специалиста по адаптации скетча.
Это проблема, конечно. Если замена prog_char на const char не поможет, то тут нужна работа специалиста по адаптации скетча.
Может и это тоже. Но я полагал, что к 2019-му году проблема с национальными символами в Windows решена.
Не помогло. А почему в старой версии Арудино 0023 без проблем комплиируется.Помогите тогда прошить с её помощью.У меня при выборе программатора когда нажимешь Burn Bootloader,выдается ошибка на любых хотя на ардуино зеленый светодик моргает один раз при w/arduino as isp выдает ошибка avrdude:stk500 _getsync() not in sync resp=0*00
Зачем нужен "Burn Bootloader" при нормальной плате Arduino? Ctrl-U и всё.
Спасибо большое.Вроде прошилось.Светодиод tx должен моргать? 3раза через 6 секунд.
Если работает и не мешает, то пусть моргает.
А на схеме у дисплея не надо 15 и 16 разъем поменять местами? А то у меня никаких символов на экране.
Привет всем .Короче спалил я свою ардуино нано. В схеме у дисплея питание не правильно подходит.Сразу не посмотрел печатку развел.
Всё заработало.Символы приветствия выводятся,но нет подсветки.Пин 3 на дисплее подключил на пин D11(PB3) на ардуино.
Пин 16 на дисплее подключил через транзистор на пин D3(PD3). Помогите.
LiquidCrystal lcd(LCD_RS, LCD_ENABLE, LCD_DATA1, LCD_DATA2, LCD_DATA3, LCD_DATA4);
#define ContrastPin 11
#define BrightnessPin 3
Оказался транзистор не исправным.Заменил на кт3102.Светит на полную.Кроме приветствия ничего нет.Меню не реагирует.Яркость какая должна быть по умолчанию?Помогите.
https://forum.arduino.cc/index.php?topic=166818.0 Такая же проблема была.Не понял как решили.
Через потенциометр контрастность регулируется.Я так понял пока нет сигнала с K-линии нет и меню.
Привет всем.Подскажите пожалуйста какую строку в скетче нужно закомментировать или раскоментировать ,чтобы меню выводилось на дисплей без подключения ЭБУ,пробовал 245 строку , пишет error.
Оказалась 260 строка в скетче.Разбирюсь в меню. Почему то при больших символах на две строки,получается не правильный ноль.Почти восьмерка.Что то в скетче не так.
Контрастность,подсветку регулирует,параметры с ЭБУ выводит,напряжение показывает.Температуру почему то нет ни с одного датчика,иногда скачет с минус до плюса.В чём может быть проблема подскажите.
Если сделать правильный ноль ,получается не правильная восьмерка или пятерка.С температурой так и не разберусь.Если на минус датчик кинуть получается -46,5 градусов.Если на плюс +123,5.Причём с одним датчиком показывает одинаковое значение ,что наружняя температура ,что внутренняя.Что сделать подскажите.Может в скетче что то изменить.
Чтобы подсказать - нужно собрать то же самое, что и у Вас. Наверное никому неинтересно это делать - отсюда и молчание.
Просто датчик не заработает. Надо датчики подключить с A1 и A2 на землю, а сами A1 и A2 каждый через свой резистор к +5. Вот только номинал этого резистора знает тот кто писал скетч и таблицу для тарировки.
Спасибо.Скорее всего 10 ком,так же как и у вольтметра.Попробую.
поставьте датчики температуры ds18b20
А со скетчем поможете? Сам я не смогу. А в данном скетче как датчик KTY81/210 к ардуино подключить пробовал разные резисторы не получается.
Разобрался.Резистор нужно ставить 2 ком.
https://www.mikrocontroller.net/attachment/243060/KTY81-110-6.png
Наверное L9637D сгорела.При прошивке пишет avrdude stk500_getparm() (a) protocol error,expect=0*14,resp=0*00
Double check connections and try again,or use -F to override Если отпаять RX от L9637 прошивается без проблем.
Проверил через OpenDiagFree пишет адаптер найден.Значит L9637d в порядке?
При подключении к авто ЭБУ пошел дымок .СН340с на ардуино пришел конец.Значит L9637 была пробита.
https://www.dropbox.com/s/hfq3x0dovax5hu5/Obduino32.lay6?dl=0
Печатка под ардуино нано.
... пошел дымок ...
Главное что бы не от авто шел дымок
Да я думал всё трындец мозгам.Нет завелась нормально.При пайке замкнул две ноги на 9637.Ну всё ардуино закончились да и я устал чё то с этим БК.