Rev 11 | Details | Compare with Previous | Last modification | View Log | RSS feed
| Rev | Author | Line No. | Line |
|---|---|---|---|
| 10 | mjames | 1 | |
| 2 | |||
| 3 | #include "saveTiming.h" |
||
| 4 | |||
| 5 | #include "nvram.h" |
||
| 11 | mjames | 6 | #include "main.h" |
| 10 | mjames | 7 | |
| 8 | #include "libIgnTiming/timing.H" |
||
| 9 | |||
| 18 | mjames | 10 | extern void watchdogWrite(); |
| 11 | |||
| 10 | mjames | 12 | // define tags for items |
| 13 | static const uint8_t TIMING_OFFSET_TAG = 1; // timing offset tag |
||
| 14 | static const uint8_t TIMING_LOW_TAG = 0x10; |
||
| 15 | static const uint8_t VACUUM_LOW_TAG = 0x30; |
||
| 16 | static const uint8_t MAP_BASE_TAG = 0x50; |
||
| 17 | static const uint8_t MAP_ROW_OFFSET = 0x10; |
||
| 18 | static const uint8_t UINT16_LOW_OFFSET = 0x10; |
||
| 19 | static const uint8_t UINT16_HIGH_OFFSET = 0x00; // nothing but it looks tidier |
||
| 20 | |||
| 21 | /// @brief Load 16 bit data from two tagged byte items |
||
| 22 | /// @param baseTag Tag to use for indexing |
||
| 23 | /// @param data pointer to data to load value into |
||
| 24 | /// @return true if succeeded |
||
| 25 | static uint8_t load_uint16_t(uint8_t baseTag, uint16_t *data) |
||
| 26 | { |
||
| 27 | nvram_info_t *found_high = find_nvram_data(baseTag+ UINT16_HIGH_OFFSET); |
||
| 28 | if (!found_high) |
||
| 29 | return 0; |
||
| 30 | nvram_info_t *found_low = find_nvram_data(baseTag + UINT16_LOW_OFFSET); |
||
| 31 | if (found_low) |
||
| 32 | return 0; |
||
| 33 | *data = (found_high->data.val << 8) | (found_low->data.val); |
||
| 34 | return 1; |
||
| 35 | } |
||
| 36 | |||
| 37 | /// @brief Save 16 bit data in two tagged byte items |
||
| 38 | /// @param baseTag |
||
| 39 | /// @param data data to write |
||
| 40 | static void save_uint16_t(uint8_t baseTag, uint16_t data) |
||
| 41 | { |
||
| 42 | nvram_info_t info; |
||
| 43 | info.data.tag = baseTag + UINT16_HIGH_OFFSET; |
||
| 44 | info.data.val = data >> 8; |
||
| 45 | write_nvram_data(info); |
||
| 46 | info.data.tag = baseTag + UINT16_LOW_OFFSET; |
||
| 47 | info.data.val = data & 0xFF; |
||
| 48 | write_nvram_data(info); |
||
| 49 | } |
||
| 50 | |||
| 51 | ///@brief load the timing info in from NVRAM |
||
| 52 | void loadTimingInfoFromNvram() |
||
| 53 | { |
||
| 54 | uint8_t missingData = 0; |
||
| 55 | |||
| 56 | nvram_info_t *found = find_nvram_data(TIMING_OFFSET_TAG); |
||
| 57 | if (found) |
||
| 58 | setTimingAdjust(found->data.val); |
||
| 59 | else |
||
| 60 | missingData = 1; |
||
| 61 | |||
| 62 | // load in timing map column heading values |
||
| 11 | mjames | 63 | for (int i = 0; i < MAX_RPM_POINTS; i++) |
| 10 | mjames | 64 | { |
| 65 | uint16_t val; |
||
| 66 | uint8_t found = load_uint16_t(TIMING_LOW_TAG + i, &val); |
||
| 67 | if (found) |
||
| 68 | setRpmMap(i, val); |
||
| 69 | else |
||
| 70 | missingData = 1; |
||
| 71 | } |
||
| 72 | |||
| 73 | // load in vacuum map row heading values |
||
| 74 | for (int i = 0; i < MAX_VACUUM_POINTS; i++) |
||
| 75 | { |
||
| 76 | uint16_t val; |
||
| 77 | uint8_t found = load_uint16_t(VACUUM_LOW_TAG + i, &val); |
||
| 78 | if (found) |
||
| 79 | setVacuumMap(i, val); |
||
| 80 | else |
||
| 81 | missingData = 1; |
||
| 82 | } |
||
| 83 | |||
| 84 | for (int i = 0; i < MAX_VACUUM_POINTS; i++) |
||
| 85 | { |
||
| 86 | uint8_t tag_base = i * MAP_ROW_OFFSET + MAP_BASE_TAG; |
||
| 11 | mjames | 87 | for (int j = 0; j < MAX_RPM_POINTS; j++) |
| 10 | mjames | 88 | { |
| 89 | found = find_nvram_data(tag_base + j); |
||
| 90 | if (found) |
||
| 91 | setTiming(i, j, found->data.val); |
||
| 92 | else |
||
| 93 | missingData = 1; |
||
| 94 | } |
||
| 95 | } |
||
| 96 | |||
| 97 | if (missingData) |
||
| 98 | saveTimingInfoToNvram(); |
||
| 99 | } |
||
| 100 | |||
| 11 | mjames | 101 | /// @brief Save timing info to NVRAM : this relies on the |
| 10 | mjames | 102 | void saveTimingInfoToNvram() |
| 103 | { |
||
| 104 | nvram_info_t info; |
||
| 105 | info.data.tag = TIMING_OFFSET_TAG; |
||
| 106 | info.data.val = getTimingAdjust(); |
||
| 11 | mjames | 107 | watchdogWrite(); |
| 10 | mjames | 108 | write_nvram_data(info); |
| 109 | |||
| 110 | // load in timing map column heading values |
||
| 11 | mjames | 111 | for (int i = 0; i < MAX_RPM_POINTS; i++) |
| 10 | mjames | 112 | { |
| 113 | uint16_t val = getRpmMap(i); |
||
| 114 | save_uint16_t(TIMING_LOW_TAG + i, val); |
||
| 115 | } |
||
| 116 | |||
| 117 | // load in vacuum map row heading values |
||
| 118 | for (int i = 0; i < MAX_VACUUM_POINTS; i++) |
||
| 119 | { |
||
| 120 | uint16_t val = getVacuumMap(i); |
||
| 11 | mjames | 121 | watchdogWrite(); |
| 10 | mjames | 122 | save_uint16_t(VACUUM_LOW_TAG + i, val); |
| 123 | } |
||
| 124 | |||
| 125 | // save all the data values |
||
| 126 | for (int i = 0; i < MAX_VACUUM_POINTS; i++) |
||
| 127 | { |
||
| 128 | uint8_t tag_base = i * MAP_ROW_OFFSET+MAP_BASE_TAG; |
||
| 11 | mjames | 129 | for (int j = 0; j < MAX_RPM_POINTS; j++) |
| 10 | mjames | 130 | { |
| 131 | info.data.val = getTiming(i,j); |
||
| 132 | info.data.tag = tag_base + j; |
||
| 11 | mjames | 133 | watchdogWrite(); |
| 10 | mjames | 134 | write_nvram_data(info); |
| 135 | |||
| 136 | } |
||
| 137 | } |
||
| 138 | } |