PageRenderTime 55ms CodeModel.GetById 26ms RepoModel.GetById 1ms app.codeStats 0ms

/src/main/init_old.c

https://gitlab.com/libreems-suite/libreems-firmware
C | 586 lines | 294 code | 70 blank | 222 comment | 1 complexity | 504180e818db263e1623f880215ea7e3 MD5 | raw file
    

  1. /* FreeEMS - the open source engine management system
    2. 

  2.  *
    3. 

  3.  * Copyright 2008-2013 Fred Cooke
    4. 

  4.  *
    5. 

  5.  * This file is part of the FreeEMS project.
    6. 

  6.  *
    7. 

  7.  * FreeEMS software is free software: you can redistribute it and/or modify
    8. 

  8.  * it under the terms of the GNU General Public License as published by
    9. 

  9.  * the Free Software Foundation, either version 3 of the License, or
    10. 

  10.  * (at your option) any later version.
    11. 

  11.  *
    12. 

  12.  * FreeEMS software is distributed in the hope that it will be useful,
    13. 

  13.  * but WITHOUT ANY WARRANTY; without even the implied warranty of
    14. 

  14.  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
    15. 

  15.  * GNU General Public License for more details.
    16. 

  16.  *
    17. 

  17.  * You should have received a copy of the GNU General Public License
    18. 

  18.  * along with any FreeEMS software.  If not, see http://www.gnu.org/licenses/
    19. 

  19.  *
    20. 

  20.  * We ask that if you make any changes to this file you email them upstream to
    21. 

  21.  * us at admin(at)diyefi(dot)org or, even better, fork the code on github.com!
    22. 

  22.  *
    23. 

  23.  * Thank you for choosing FreeEMS to run your engine!
    24. 

  24.  */
    25. 

  25. 

  26. 

  27. /** @file
    28. 

  28.  *
    29. 

  29.  * @brief Initialise the devices state
    30. 

  30.  *
    31. 

  31.  * Setup, configure and initialise all aspects of the devices state including
    32. 

  32.  * but not limited to:
    33. 

  33.  *
    34. 

  34.  * - Setup the bus clock speed
    35. 

  35.  * - Configuration based variable initialisation
    36. 

  36.  * - I/O register behaviour and initial state
    37. 

  37.  * - Configure and enable interrupts
    38. 

  38.  * - Copy tunable data up to RAM from flash
    39. 

  39.  * - Configure peripheral module behaviour
    40. 

  40.  */
    41. 

  41. 

  42. 

  43. #define INIT_DEPRICATED_C
    44. 

  44. #include "inc/freeEMS.h"
    45. 

  45. #include "inc/interrupts_depricated.h"
    46. 

  46. #include "inc/utils.h"
    47. 

  47. #include "inc/commsISRs.h"
    48. 

  48. #include "inc/init_depricated.h"
    49. 

  49. #include "inc/init.h"
    50. 

  50. #include "inc/Configuration.h"
    51. 

  51. #include <string.h>
    52. 

  52. #include "inc/CANcomms.h"
    53. 

  53. #include "engineAngleDecoders/common/interface.h"
    54. 

  54. 

  55. extern KeyUserDebug KeyUserDebugs;
    56. 

  56. 

  57. 

  58. 

  59. /** @brief Set the PLL clock frequency
    60. 

  60.  *
    61. 

  61.  * Set the Phase Locked Loop to our desired frequency (80MHz) and enable PLL.
    62. 

  62.  */
    63. 

  63. void initPLL(){
    64. 

  64.   CLKSEL &= PLLSELOFF;  /* Switches to base external OSCCLK to ensure PLL is not being used (off out of reset, but not sure if the monitor turns it on before passing control or not) */
    65. 

  65.   PLLCTL &= PLLOFF;     /* Turn the PLL device off to adjust its speed (on by default out of reset) */
    66. 

  66.   REFDV = PLLDIVISOR;   /* 16MHz / (3 + 1) = 4MHz Bus frequency */
    67. 

  67.   SYNR = PLLMULTIPLIER; /* 4MHz * (9 + 1) = 40MHz Bus frequency */
    68. 

  68.   PLLCTL |= PLLON;      /* Turn the PLL device back on again at 80MHz */
    69. 

  69.   enablePLL();
    70. 

  70. }
    71. 

  71. 

  72. /** @brief Switch to using PLL
    73. 

  73.  *
    74. 

  74.  * Switch to using PLL for clock (40MHz bus speed). Interrupt is enabled elsewhere.
    75. 

  75.  *
    76. 

  76.  * Note: Requires busy wait loop, only for init and emergency use.
    77. 

  77.  *
    78. 

  78.  * @todo Should be limited, and have break out with error code and fall back mechanism.
    79. 

  79.  */
    80. 

  80. void enablePLL(){
    81. 

  81.   while (!(CRGFLG & LOCK)){
    82. 

  82.     /* Do nothing while we wait till the PLL loop locks onto the target frequency. */
    83. 

  83.     /* Target frequency is given by (2 * (crystal frequency / (REFDV + 1)) * (SYNR + 1)) */
    84. 

  84.     /* Bus frequency is half PLL frequency and given by ((crystal frequency / (REFDV + 1)) * (SYNR + 1)) */
    85. 

  85.   }
    86. 

  86. 

  87.   CLKSEL = PLLSEL; /* Switches to PLL clock for internal bus frequency        */
    88. 

  88.   /* from MC9S12XDP512V2.pdf Section 2.4.1.1.2 page 101 Third paragraph       */
    89. 

  89.   /* "This takes a MAXIMUM of 4 OSCCLK clock cylces PLUS 4 PLL clock cycles"  */
    90. 

  90.   /* "During this time ALL clocks freeze, and CPU activity ceases"            */
    91. 

  91.   /* Therefore there is no point waiting for this to occur, we already are... */
    92. 

  92. }
    93. 

  93. 

  94. 

  95. /// Set up the analogue inputs
    96. 

  96. void initADC(){
    97. 

  97.   // Currently not true, and may never be: TODO When the port something uses
    98. 

  98.   // is changed via the tuning interface, the configuration will be done on
    99. 

  99.   // the fly, and the value burned to flash such that next boot happens
    100. 

  100.   // correctly and current running devices are used in that way.
    101. 

  101. 

  102.   /* Digital input buffers on the ATD channels are off by default, leave them this way! */
    103. 

  103.   //ATD0DIEN = ZEROS; /* You are out of your mind if you waste this on digital Inputs */
    104. 

  104.   //ATD1DIEN0 = ZEROS; /* You are out of your mind if you waste this on digital Inputs (NOT-bonded, can't use) */
    105. 

  105.   //ATD1DIEN1 = ZEROS; /* You are out of your mind if you waste this on digital Inputs */
    106. 

  106. 

  107.   /* And configure them all for analog input */
    108. 

  108.   //ATD0CTL0 = 0x07/* With mult turned on this is required to be set to cause wrap around, but is correct out of reset */
    109. 

  109.   //ATD0CTL1 = 0x07/* Trigger and interrupt configuration, unused for now. */
    110. 

  110.   ATD0CTL2 = 0xC0; /* Turns on the ADC block and sets auto flag clear */
    111. 

  111.   ATD0CTL3 = 0x40; /* Set sequence length = 8 */
    112. 

  112.   ATD0CTL4 = 0x73; /* Set the ADC clock and sample period for best accuracy */
    113. 

  113.   ATD0CTL5 = 0xB0; /* Sets justification to right, multiplex and scan all channels. Writing to this causes conversions to begin */
    114. 

  114. 

  115.   /* And configure them all for analog input */
    116. 

  116.   ATD1CTL0 = 0x07; /* TODO bring this out of config based on chip variant variable. Sets wrap on 8th ADC because we can't use the other 8 on 112 pin version */
    117. 

  117.   //ATD0CTL1 = 0x07/* Trigger and interrupt configuration, unused for now. */
    118. 

  118.   ATD1CTL2 = 0xC0; /* Turns on the ADC block and sets auto flag clear */
    119. 

  119.   ATD1CTL3 = 0x40; /* Set sequence length = 8 */
    120. 

  120.   ATD1CTL4 = 0x73; /* Set the ADC clock and sample period for best accuracy */
    121. 

  121.   ATD1CTL5 = 0xB0; /* Sets justification to right, multiplex and scan all channels. Writing to this causes conversions to begin */
    122. 

  122. }
    123. 

  123. 

  124. 

  125. /** @brief Buffer lookup tables addresses
    126. 

  126.  *
    127. 

  127.  * Save pointers to the lookup tables which live in paged flash.
    128. 

  128.  */
    129. 

  129. void initLookupAddresses(){
    130. 

  130.   extern const volatile uint16_t IATTransferTable[]; /* 2k */                                                                            
    131. 

  131.   extern const volatile uint16_t CHTTransferTable[]; /* 2k */
    132. 

  132.   extern const volatile uint16_t MAFTransferTable[]; /* 2k */
    133. 

  133.   extern const volatile uint8_t TestTransferTable[];
    134. 

  134.   extern void* IATTransferTableLocation;
    135. 

  135.   extern void* CHTTransferTableLocation;
    136. 

  136.   extern void* MAFTransferTableLocation;
    137. 

  137.   extern void* TestTransferTableLocation;
    138. 

  138.   IATTransferTableLocation = (void*)&IATTransferTable;
    139. 

  139.   CHTTransferTableLocation = (void*)&CHTTransferTable;
    140. 

  140.   MAFTransferTableLocation = (void*)&MAFTransferTable;
    141. 

  141.   TestTransferTableLocation = (void*)&TestTransferTable;
    142. 

  142. }
    143. 

  143. 

  144. 

  145. /** @brief Buffer fuel tables addresses
    146. 

  146.  *
    147. 

  147.  * Save pointers to the fuel tables which live in paged flash.
    148. 

  148.  */
    149. 

  149. void initFuelAddresses(){
    150. 

  150.   extern const volatile mainTable VETableMainFlash;                                                                                                
    151. 

  151.   extern const volatile mainTable VETableSecondaryFlash;
    152. 

  152.   extern const volatile mainTable AirflowTableFlash;
    153. 

  153.   extern const volatile mainTable LambdaTableFlash;
    154. 

  154.   extern const volatile mainTable VETableMainFlash2;
    155. 

  155.   extern const volatile mainTable VETableSecondaryFlash2;
    156. 

  156.   extern const volatile mainTable AirflowTableFlash2;
    157. 

  157.   extern const volatile mainTable LambdaTableFlash2;
    158. 

  158.   extern void* VETableMainFlashLocation;
    159. 

  159.   extern void* VETableMainFlash2Location;
    160. 

  160.   extern void* VETableSecondaryFlashLocation;
    161. 

  161.   extern void* VETableSecondaryFlash2Location;
    162. 

  162.   extern void* AirflowTableFlashLocation;
    163. 

  163.   extern void* AirflowTableFlash2Location;
    164. 

  164.   extern void* LambdaTableFlashLocation;
    165. 

  165.   extern void* LambdaTableFlash2Location;
    166. 

  166. 

  167.   /* Setup addresses within the page to avoid warnings */
    168. 

  168.   VETableMainFlashLocation       = (void*)&VETableMainFlash;
    169. 

  169.   VETableSecondaryFlashLocation  = (void*)&VETableSecondaryFlash;
    170. 

  170.   AirflowTableFlashLocation      = (void*)&AirflowTableFlash;
    171. 

  171.   LambdaTableFlashLocation       = (void*)&LambdaTableFlash;
    172. 

  172.   VETableMainFlash2Location      = (void*)&VETableMainFlash2;
    173. 

  173.   VETableSecondaryFlash2Location = (void*)&VETableSecondaryFlash2;
    174. 

  174.   AirflowTableFlash2Location     = (void*)&AirflowTableFlash2;
    175. 

  175.   LambdaTableFlash2Location      = (void*)&LambdaTableFlash2;
    176. 

  176. }
    177. 

  177. 

  178. 

  179. /** @brief Copy fuel tables to RAM
    180. 

  180.  *
    181. 

  181.  * Initialises the fuel tables in RAM by copying them up from flash.
    182. 

  182.  */
    183. 

  183. void initPagedRAMFuel(void){
    184. 

  184.   extern void* VETableMainFlashLocation;
    185. 

  185.   extern void* VETableMainFlash2Location;
    186. 

  186.   extern void* VETableSecondaryFlashLocation;
    187. 

  187.   extern void* VETableSecondaryFlash2Location;
    188. 

  188.   extern void* AirflowTableFlashLocation;
    189. 

  189.   extern void* AirflowTableFlash2Location;
    190. 

  190.   extern void* LambdaTableFlashLocation;
    191. 

  191.   extern void* LambdaTableFlash2Location;
    192. 

  192.   /* Copy the tables from flash to RAM */
    193. 

  193.   RPAGE = RPAGE_FUEL_ONE;
    194. 

  194.   memcpy((void*)&TablesA, VETableMainFlashLocation,       sizeof(mainTable));
    195. 

  195.   memcpy((void*)&TablesB, VETableSecondaryFlashLocation,  sizeof(mainTable));
    196. 

  196.   memcpy((void*)&TablesC, AirflowTableFlashLocation,      sizeof(mainTable));
    197. 

  197.   memcpy((void*)&TablesD, LambdaTableFlashLocation,       sizeof(mainTable));
    198. 

  198.   RPAGE = RPAGE_FUEL_TWO;
    199. 

  199.   memcpy((void*)&TablesA, VETableMainFlash2Location,      sizeof(mainTable));
    200. 

  200.   memcpy((void*)&TablesB, VETableSecondaryFlash2Location, sizeof(mainTable));
    201. 

  201.   memcpy((void*)&TablesC, AirflowTableFlash2Location,     sizeof(mainTable));
    202. 

  202.   memcpy((void*)&TablesD, LambdaTableFlash2Location,      sizeof(mainTable));
    203. 

  203. }
    204. 

  204. 

  205. 

  206. /** @brief Buffer timing tables addresses
    207. 

  207.  *
    208. 

  208.  * Save pointers to the timing tables which live in paged flash.
    209. 

  209.  */
    210. 

  210. void initTimingAddresses(){
    211. 

  211.   extern const volatile mainTable IgnitionAdvanceTableMainFlash;
    212. 

  212.   extern const volatile mainTable IgnitionAdvanceTableSecondaryFlash;
    213. 

  213.   extern const volatile mainTable InjectionAdvanceTableMainFlash;
    214. 

  214.   extern const volatile mainTable InjectionAdvanceTableSecondaryFlash;
    215. 

  215.   extern const volatile mainTable IgnitionAdvanceTableMainFlash2;
    216. 

  216.   extern const volatile mainTable IgnitionAdvanceTableSecondaryFlash2;
    217. 

  217.   extern const volatile mainTable InjectionAdvanceTableMainFlash2;
    218. 

  218.   extern const volatile mainTable InjectionAdvanceTableSecondaryFlash2;
    219. 

  219.   extern void* IgnitionAdvanceTableMainFlashLocation;
    220. 

  220.   extern void* IgnitionAdvanceTableMainFlash2Location;
    221. 

  221.   extern void* IgnitionAdvanceTableSecondaryFlashLocation;
    222. 

  222.   extern void* IgnitionAdvanceTableSecondaryFlash2Location;
    223. 

  223.   extern void* InjectionAdvanceTableMainFlashLocation;
    224. 

  224.   extern void* InjectionAdvanceTableMainFlash2Location;
    225. 

  225.   extern void* InjectionAdvanceTableSecondaryFlashLocation;
    226. 

  226.   extern void* InjectionAdvanceTableSecondaryFlash2Location;
    227. 

  227.   /* Setup addresses within the page to avoid warnings */
    228. 

  228.   IgnitionAdvanceTableMainFlashLocation        = (void*)&IgnitionAdvanceTableMainFlash;
    229. 

  229.   IgnitionAdvanceTableSecondaryFlashLocation   = (void*)&IgnitionAdvanceTableSecondaryFlash;
    230. 

  230.   InjectionAdvanceTableMainFlashLocation       = (void*)&InjectionAdvanceTableMainFlash;
    231. 

  231.   InjectionAdvanceTableSecondaryFlashLocation  = (void*)&InjectionAdvanceTableSecondaryFlash;
    232. 

  232.   IgnitionAdvanceTableMainFlash2Location       = (void*)&IgnitionAdvanceTableMainFlash2;
    233. 

  233.   IgnitionAdvanceTableSecondaryFlash2Location  = (void*)&IgnitionAdvanceTableSecondaryFlash2;
    234. 

  234.   InjectionAdvanceTableMainFlash2Location      = (void*)&InjectionAdvanceTableMainFlash2;
    235. 

  235.   InjectionAdvanceTableSecondaryFlash2Location = (void*)&InjectionAdvanceTableSecondaryFlash2;
    236. 

  236. }
    237. 

  237. 

  238. 

  239. /** @brief Copy timing tables to RAM
    240. 

  240.  *
    241. 

  241.  * Initialises the timing tables in RAM by copying them up from flash.
    242. 

  242.  */
    243. 

  243. void initPagedRAMTime(){
    244. 

  244.   extern void* IgnitionAdvanceTableMainFlashLocation;
    245. 

  245.   extern void* IgnitionAdvanceTableMainFlash2Location;
    246. 

  246.   extern void* IgnitionAdvanceTableSecondaryFlashLocation;
    247. 

  247.   extern void* IgnitionAdvanceTableSecondaryFlash2Location;
    248. 

  248.   extern void* InjectionAdvanceTableMainFlashLocation;
    249. 

  249.   extern void* InjectionAdvanceTableMainFlash2Location;
    250. 

  250.   extern void* InjectionAdvanceTableSecondaryFlashLocation;
    251. 

  251.   extern void* InjectionAdvanceTableSecondaryFlash2Location;
    252. 

  252.   /* Copy the tables from flash to RAM */
    253. 

  253.   RPAGE = RPAGE_TIME_ONE;
    254. 

  254.   memcpy((void*)&TablesA, IgnitionAdvanceTableMainFlashLocation,        sizeof(mainTable));
    255. 

  255.   memcpy((void*)&TablesB, IgnitionAdvanceTableSecondaryFlashLocation,   sizeof(mainTable));
    256. 

  256.   memcpy((void*)&TablesC, InjectionAdvanceTableMainFlashLocation,       sizeof(mainTable));
    257. 

  257.   memcpy((void*)&TablesD, InjectionAdvanceTableSecondaryFlashLocation,  sizeof(mainTable));
    258. 

  258.   RPAGE = RPAGE_TIME_TWO;
    259. 

  259.   memcpy((void*)&TablesA, IgnitionAdvanceTableMainFlash2Location,       sizeof(mainTable));
    260. 

  260.   memcpy((void*)&TablesB, IgnitionAdvanceTableSecondaryFlash2Location,  sizeof(mainTable));
    261. 

  261.   memcpy((void*)&TablesC, InjectionAdvanceTableMainFlash2Location,      sizeof(mainTable));
    262. 

  262.   memcpy((void*)&TablesD, InjectionAdvanceTableSecondaryFlash2Location, sizeof(mainTable));
    263. 

  263. }
    264. 

  264. 

  265. 

  266. /** @brief Buffer tunable tables addresses
    267. 

  267.  *
    268. 

  268.  * Save pointers to the tunable tables which live in paged flash and their
    269. 

  269.  * sub-sections too.
    270. 

  270.  */
    271. 

  271. void initTunableAddresses(){
    272. 

  272.   /* Setup addresses within the page to avoid warnings */
    273. 

  273.   extern const volatile SmallTables1 SmallTablesAFlash;
    274. 

  274.   extern const volatile SmallTables2 SmallTablesBFlash;
    275. 

  275.   extern const volatile SmallTables3 SmallTablesCFlash;
    276. 

  276.   extern const volatile SmallTables4 SmallTablesDFlash;
    277. 

  277.   extern const volatile SmallTables1 SmallTablesAFlash2;
    278. 

  278.   extern const volatile SmallTables2 SmallTablesBFlash2;
    279. 

  279.   extern const volatile SmallTables3 SmallTablesCFlash2;
    280. 

  280.   extern const volatile SmallTables4 SmallTablesDFlash2;
    281. 

  281.   /* Tunable blocks */
    282. 

  282.   extern void* SmallTablesAFlashLocation;
    283. 

  283.   extern void* SmallTablesAFlash2Location;
    284. 

  284.   extern void* SmallTablesBFlashLocation;
    285. 

  285.   extern void* SmallTablesBFlash2Location;
    286. 

  286.   extern void* SmallTablesCFlashLocation;
    287. 

  287.   extern void* SmallTablesCFlash2Location;
    288. 

  288.   extern void* SmallTablesDFlashLocation;
    289. 

  289.   extern void* SmallTablesDFlash2Location;
    290. 

  290.   /* Small chunks of TablesA here */
    291. 

  291.   extern void* voltageVersusDwellDesiredTableLocation;
    292. 

  292.   extern void* voltageVersusDwellDesiredTable2Location;
    293. 

  293.   extern void* injectorDeadTimeTableLocation;
    294. 

  294.   extern void* injectorDeadTimeTable2Location;
    295. 

  295.   extern void* postStartEnrichmentTableLocation;
    296. 

  296.   extern void* postStartEnrichmentTable2Location;
    297. 

  297.   extern void* primingVolumeTableLocation;
    298. 

  298.   extern void* primingVolumeTable2Location;
    299. 

  299.   extern void* engineTempEnrichmentTableLocation;
    300. 

  300.   extern void* engineTempEnrichmentTable2Location;
    301. 

  301.   extern void* RPMVersusDwellTableLocation;
    302. 

  302.   extern void* RPMVersusDwellTable2Location;
    303. 

  303.   extern void* RPMVersusBlendTableLocation;
    304. 

  304.   extern void* RPMVersusBlendTable2Location;
    305. 

  305. 

  306.   /* Small chunks of TablesB here */
    307. 

  307.   extern void* loggingSettingsLocation;
    308. 

  308.   extern void* loggingSettings2Location;
    309. 

  309.   extern void* perCylinderFuelTrimsLocation;
    310. 

  310.   extern void* perCylinderFuelTrims2Location;
    311. 

  311.   /* Small chunks of TablesC here */
    312. 

  312.   extern void* MAFvsVoltageTableLocation;
    313. 

  313.   extern void* IATvsIgnitionTableLocation;
    314. 

  314.   extern void* CLTvsIgnitionTableLocation;
    315. 

  315.   extern void* ETHvsIgnitionTableLocation;
    316. 

  316.   extern void* fuelDeltaVersusPercentAdderTableLocation;
    317. 

  317.   extern void* EGOlutTableLocation;
    318. 

  318.   extern void* EGTlutTableLocation;
    319. 

  319.   extern void* AAPlutTableLocation;
    320. 

  320.   extern void* MAPlutTableLocation;
    321. 

  321.   extern void* fuelPressurelutTableLocation;
    322. 

  322.   extern void* rpmVersusIACStepsTableLocation;
    323. 

  323.   extern void* rpmVersusEngineTempTableLocation;
    324. 

  324. 

  325. 

  326.   /* Fillers here */
    327. 

  327.   extern void* fillerALocation;
    328. 

  328.   extern void* fillerA2Location;
    329. 

  329.   extern void* fillerBLocation;
    330. 

  330.   extern void* fillerB2Location;
    331. 

  331.   extern void* fillerCLocation;
    332. 

  332.   extern void* fillerC2Location;
    333. 

  333.   extern void* fillerDLocation;
    334. 

  334.   extern void* fillerD2Location;
    335. 

  335. 

  336.   SmallTablesAFlashLocation  = (void*)&SmallTablesAFlash;
    337. 

  337.   SmallTablesBFlashLocation  = (void*)&SmallTablesBFlash;
    338. 

  338.   SmallTablesCFlashLocation  = (void*)&SmallTablesCFlash;
    339. 

  339.   SmallTablesDFlashLocation  = (void*)&SmallTablesDFlash;
    340. 

  340.   SmallTablesAFlash2Location = (void*)&SmallTablesAFlash2;
    341. 

  341.   SmallTablesBFlash2Location = (void*)&SmallTablesBFlash2;
    342. 

  342.   SmallTablesCFlash2Location = (void*)&SmallTablesCFlash2;
    343. 

  343.   SmallTablesDFlash2Location = (void*)&SmallTablesDFlash2;
    344. 

  344. 

  345.   /* TablesA */
    346. 

  346.   voltageVersusDwellDesiredTableLocation    = (void*)&SmallTablesAFlash.voltageVSDwellTable;
    347. 

  347.   voltageVersusDwellDesiredTable2Location   = (void*)&SmallTablesAFlash2.voltageVSDwellTable;
    348. 

  348.   injectorDeadTimeTableLocation             = (void*)&SmallTablesAFlash.injectorDeadTimeTable;
    349. 

  349.   injectorDeadTimeTable2Location            = (void*)&SmallTablesAFlash2.injectorDeadTimeTable;
    350. 

  350.   postStartEnrichmentTableLocation          = (void*)&SmallTablesAFlash.postStartEnrichmentTable;
    351. 

  351.   postStartEnrichmentTable2Location         = (void*)&SmallTablesAFlash2.postStartEnrichmentTable;
    352. 

  352.   primingVolumeTableLocation                = (void*)&SmallTablesAFlash.primingVolumeTable;
    353. 

  353.   primingVolumeTable2Location               = (void*)&SmallTablesAFlash2.primingVolumeTable;
    354. 

  354.   engineTempEnrichmentTableLocation         = (void*)&SmallTablesAFlash.engineTempEnrichmentTable;
    355. 

  355.   engineTempEnrichmentTable2Location        = (void*)&SmallTablesAFlash2.engineTempEnrichmentTable;
    356. 

  356.   RPMVersusDwellTableLocation               = (void*)&SmallTablesAFlash.RPMVersusDwellTable;
    357. 

  357.   RPMVersusDwellTable2Location              = (void*)&SmallTablesAFlash2.RPMVersusDwellTable;
    358. 

  358.   RPMVersusBlendTableLocation               = (void*)&SmallTablesAFlash.RPMVersusBlendTable;
    359. 

  359.   RPMVersusBlendTable2Location              = (void*)&SmallTablesAFlash2.RPMVersusBlendTable;
    360. 

  360. 

  361.   /* TablesB */
    362. 

  362.   loggingSettingsLocation       = (void*)&SmallTablesBFlash.loggingSettings;
    363. 

  363.   loggingSettings2Location      = (void*)&SmallTablesBFlash2.loggingSettings;
    364. 

  364.   perCylinderFuelTrimsLocation  = (void*)&SmallTablesBFlash.perCylinderFuelTrims;
    365. 

  365.   perCylinderFuelTrims2Location = (void*)&SmallTablesBFlash2.perCylinderFuelTrims;
    366. 

  366. 

  367.   /* TablesC */
    368. 

  368.   MAFvsVoltageTableLocation  = (void*) &SmallTablesCFlash.MAFvsVoltageTable;
    369. 

  369.   IATvsIgnitionTableLocation = (void*) &SmallTablesCFlash.IATvsIgnitionTable;
    370. 

  370.   CLTvsIgnitionTableLocation = (void*) &SmallTablesCFlash.CLTvsIgnitionTable;
    371. 

  371.   ETHvsIgnitionTableLocation = (void*) &SmallTablesCFlash.ETHvsIgnitionTable;
    372. 

  372.   EGOlutTableLocation        = (void*) &SmallTablesCFlash.EGOlut;
    373. 

  373.   EGTlutTableLocation        = (void*) &SmallTablesCFlash.EGTlut;
    374. 

  374.   AAPlutTableLocation        = (void*) &SmallTablesCFlash.AAPlut;
    375. 

  375.   MAPlutTableLocation        = (void*) &SmallTablesCFlash.MAPlut;
    376. 

  376.   fuelPressurelutTableLocation = (void*) &SmallTablesCFlash.fuelPressureLUT;
    377. 

  377.   rpmVersusIACStepsTableLocation = (void*) &SmallTablesCFlash.rpmVersusIACStepsTable;
    378. 

  378.   rpmVersusEngineTempTableLocation = (void*) &SmallTablesCFlash.rpmVersusEngineTempTable;
    379. 

  379.   fuelDeltaVersusPercentAdderTableLocation = (void*) &SmallTablesCFlash.fuelDeltaVersusPercentAdderTable;
    380. 

  380. 

  381.   /* TablesD */
    382. 

  382.   // TODO
    383. 

  383. 

  384.   /* filler defs */
    385. 

  385.   fillerALocation  = (void*)&SmallTablesAFlash.filler;
    386. 

  386.   fillerA2Location = (void*)&SmallTablesAFlash2.filler;
    387. 

  387.   fillerBLocation  = (void*)&SmallTablesBFlash.filler;
    388. 

  388.   fillerB2Location = (void*)&SmallTablesBFlash2.filler;
    389. 

  389.   fillerCLocation  = (void*)&SmallTablesCFlash.filler;
    390. 

  390.   fillerC2Location = (void*)&SmallTablesCFlash2.filler;
    391. 

  391.   fillerDLocation  = (void*)&SmallTablesDFlash.filler;
    392. 

  392.   fillerD2Location = (void*)&SmallTablesDFlash2.filler;
    393. 

  393. }
    394. 

  394. 

  395. 

  396. /**
    397. 

  397.  *
    398. 

  398.  */
    399. 

  399. void initPagedRAMTune(){
    400. 

  400.   /* Tunable blocks */
    401. 

  401.   extern void* SmallTablesAFlashLocation;
    402. 

  402.   extern void* SmallTablesBFlashLocation;
    403. 

  403.   extern void* SmallTablesCFlashLocation;
    404. 

  404.   extern void* SmallTablesDFlashLocation;
    405. 

  405.   /*
    406. 

  406.   extern void* SmallTablesAFlash2Location;
    407. 

  407.   extern void* SmallTablesBFlash2Location;
    408. 

  408.   extern void* SmallTablesCFlash2Location;
    409. 

  409.   extern void* SmallTablesDFlash2Location;
    410. 

  410.   */
    411. 

  411.   
    412. 

  412.   /* Copy the tables from flash to RAM */
    413. 

  413.   RPAGE = RPAGE_TUNE_ONE;
    414. 

  414.   memcpy((void*)&TablesA, SmallTablesAFlashLocation, sizeof(mainTable));
    415. 

  415.   memcpy((void*)&TablesB, SmallTablesBFlashLocation, sizeof(mainTable));
    416. 

  416.   memcpy((void*)&TablesC, SmallTablesCFlashLocation, sizeof(mainTable));
    417. 

  417.   memcpy((void*)&TablesD, SmallTablesDFlashLocation, sizeof(mainTable));
    418. 

  418. }
    419. 

  419. 

  420. 

  421. /** @brief Buffer addresses of paged data
    422. 

  422.  *
    423. 

  423.  * Save the paged memory addresses to variables such that we can access them
    424. 

  424.  * from another paged block with no warnings.
    425. 

  425.  *
    426. 

  426.  * If you try to access paged data from the wrong place you get nasty warnings.
    427. 

  427.  * These calls to functions that live in the same page that they are addressing
    428. 

  428.  * prevent those warnings.
    429. 

  429.  *
    430. 

  430.  * @note Many thanks to Jean Bélanger for the inspiration/idea to do this!
    431. 

  431.  */
    432. 

  432. void initAllPagedAddresses(){
    433. 

  433.   /* Setup pointers to lookup tables */
    434. 

  434.   initLookupAddresses();
    435. 

  435.   /* Setup pointers to the main tables */
    436. 

  436.   initFuelAddresses();
    437. 

  437.   initTimingAddresses();
    438. 

  438.   initTunableAddresses();
    439. 

  439. }
    440. 

  440. 

  441. 

  442. /** @brief Copies paged flash to RAM
    443. 

  443.  *
    444. 

  444.  * Take the tables and config from flash up to RAM to allow live tuning.
    445. 

  445.  *
    446. 

  446.  * For the main tables and other paged config we need to adjust
    447. 

  447.  * the RPAGE value to the appropriate one before copying up.
    448. 

  448.  *
    449. 

  449.  * This function is simply a delegator to the ones for each flash page. Each
    450. 

  450.  * one lives in the same paged space as the data it is copying up.
    451. 

  451.  */
    452. 

  452. void initAllPagedRAM(){
    453. 

  453.   /* Setup the flash block pointers before copying flash to RAM using them */
    454. 

  454.   initAllPagedAddresses();
    455. 

  455. 

  456.   /* Copy the tables up to their paged RAM blocks through the window from flash */
    457. 

  457.   initPagedRAMFuel();
    458. 

  458.   initPagedRAMTime();
    459. 

  459.   initPagedRAMTune();
    460. 

  460. 

  461.   /* Default to page one for now, perhaps read the configured port straight out of reset in future? TODO */
    462. 

  462.   setupPagedRAM(TRUE); // probably something like (PORTA & TableSwitchingMask)
    463. 

  463. }
    464. 

  464. 

  465. 

  466. /* Initialise and set up all running variables that require a non-zero start value here */
    467. 

  467. /* All other variables are initialised to zero by the premain built in code             */
    468. 

  468. void initVariables(){
    469. 

  469.   /* And the opposite for the other halves */
    470. 

  470.   CoreVars = &CoreVars_g;
    471. 

  471.   DerivedVars = &DerivedVars0;
    472. 

  472. 

  473.   coreStatusA |= FUEL_PUMP_PRIME;
    474. 

  474. 

  475. }
    476. 

  476. 

  477. 

  478. /** @brief Flash module setup
    479. 

  479.  *
    480. 

  480.  * Initialise configuration registers for the flash module to allow burning of
    481. 

  481.  * non-volatile flash memory from within the firmware.
    482. 

  482.  *
    483. 

  483.  * The FCLKDIV register can be written once only after reset, thus the lower
    484. 

  484.  * seven bits and the PRDIV8 bit must be set at the same time.
    485. 

  485.  *
    486. 

  486.  * We want to put the flash clock as high as possible between 150kHz and 200kHz
    487. 

  487.  *
    488. 

  488.  * The oscillator clock is 16MHz and because that is above 12.8MHz we will set
    489. 

  489.  * the PRDIV8 bit to further divide by 8 bits as per the manual.
    490. 

  490.  *
    491. 

  491.  * 16MHz = 16000KHz which pre-divided by 8 is 2000kHz
    492. 

  492.  *
    493. 

  493.  * 2000kHz / 200kHz = 10 thus we want to set the divide register to 10 or 0x0A
    494. 

  494.  *
    495. 

  495.  * Combining 0x0A with PRDIV8 gives us 0x4A (0x0A | 0x40 = 0x4A) so we use that
    496. 

  496.  *
    497. 

  497.  * @author Sean Keys
    498. 

  498.  *
    499. 

  499.  * @note If you use a different crystal lower than 12.8MHz PRDIV8 should not be set.
    500. 

  500.  *
    501. 

  501.  * @warning If the frequency you end up with is outside 150kHz - 200kHz you may
    502. 

  502.  *          damage your flash module or get corrupt data written to it.
    503. 

  503.  */
    504. 

  504. void initFlash(){
    505. 

  505.   FCLKDIV = 0x4A;                   /* Set the flash clock frequency */
    506. 

  506.   FPROT = 0xFF;                     /* Disable all flash protection  */
    507. 

  507.   FSTAT = FSTAT | (PVIOL | ACCERR); /* Clear any errors              */
    508. 

  508. }
    509. 

  509. 

  510. 

  511. /* Setup the sci module(s) that we need to use. */
    512. 

  512. void initSCIStuff(){
    513. 

  513. 

  514.   /* The alternative register set selector defaults to zero */
    515. 

  515. 

  516.   // set the baud/data speed
    517. 

  517.   SCI0BD = Config.comSettings.SC0baudDivisor;
    518. 

  518. 

  519.   // etc
    520. 

  520. 

  521.   /* Switch to alternative register set? */
    522. 

  522. 

  523.   // etc
    524. 

  524. 

  525.   /* Switch back again? */
    526. 

  526. 

  527.   /*
    528. 

  528.    * 0 = LOOPS (normal two wire operation)
    529. 

  529.    * 0 = SCISWAI (Wait mode on)
    530. 

  530.    * 0 = RSRC (if loops=1, int/ext wiring)
    531. 

  531.    * 0 = M MODE (9 data bits operation) Only set for use with parity bit.
    532. 

  532.    * 0 = WAKE (idle line wakeup)
    533. 

  533.    * 0 = ILT (idle line type count start pos)
    534. 

  534.    * 0 = PE (parity on)
    535. 

  535.    * 0 = PT (odd parity)
    536. 

  536.    *
    537. 

  537.    * 0x13 = ODD (default)
    538. 

  538.    * 0x12 = EVEN
    539. 

  539.    * 0x00 = NONE
    540. 

  540.    */
    541. 

  541.   SCI0CR1 = 0x00;
    542. 

  542. 

  543.   /*
    544. 

  544.    * 0 = TIE (tx data empty isr disabled)
    545. 

  545.    * 0 = TCIE (tx complete isr disabled)
    546. 

  546.    * 1 = RIE (rx full isr enabled)
    547. 

  547.    * 0 = ILIE (idle line isr disabled)
    548. 

  548.    * 0 = TE (transmit disabled)
    549. 

  549.    * 1 = RE (receive enabled)
    550. 

  550.    * 0 = RWU (rx wake up normal)
    551. 

  551.    * 0 = SBK (send break off)
    552. 

  552.    */
    553. 

  553.   SCI0CR2 = 0x24;
    554. 

  554. }
    555. 

  555. 

  556. 

  557. 

  558. /* Set up all the remaining interrupts */
    559. 

  559. void initInterrupts(){
    560. 

  560.   /* IMPORTANT : Set the s12x vector base register (Thanks Karsten!!) */
    561. 

  561.   IVBR = 0xF7; /* Without this the interrupts will never find your code! */
    562. 

  562. 

  563.   /* Set up the Real Time Interrupt */
    564. 

  564.   RTICTL = 0x81; /* 0b_1000_0001 0.125ms/125us period http://duckduckgo.com/?q=1+%2F+%2816MHz+%2F+%282+*+10^3%29+%29 */
    565. 

  565. //  RTICTL = 0xF9; /* 0b_1111_1001 0.125s/125ms period http://duckduckgo.com/?q=1+%2F+%2816MHz+%2F+%282*10^6%29+%29 */
    566. 

  566.   CRGINT |= (RTIE | LOCKIE | SCMIE); /* Enable the Real Time Interrupt, PLL Lock Interrupt, and Self Clock Mode Interrupt */
    567. 

  567.   CRGFLG = (RTIF | LOCKIF | SCMIF); /* Clear the RTI, LOCKI, and SCMI flags */
    568. 

  568.   RAMWPC |= AVIE; // Enable the access protection interrupt for XGATE RAM
    569. 

  569. 

  570.   // set up port H for testing
    571. 

  571.   PPSH = ZEROS; // falling edge/pull up for all
    572. 

  572.   PIEH = ONES; // enable all pins interrupts
    573. 

  573.   PIFH = ONES; // clear all port H interrupt flags
    574. 

  574. 

  575.   // TODO set up irq and xirq for testing
    576. 

  576.   // IRQCR for IRQ
    577. 

  577. 

  578.   /* VReg API setup (only for wait mode? i think so) */
    579. 

  579. //  VREGAPIR = 0x09C3; /* For 500ms period : (500ms - 0.2ms) / 0.2ms = 0b100111000011 = 2499 */
    580. 

  580. //  VREGAPICL = 0x02; /* Enable the interrupt */
    581. 

  581. //  VREGAPICL = 0x04; /* Start the counter running */
    582. 

  582.   /* Writing a one to the flag will set it if it is unset, so best not to mess with it here as it probably starts off unset */
    583. 

  583. 

  584.   /* LVI Low Voltage Interrupt enable */
    585. 

  585.   VREGCTRL = 0x02; // Counts bad power events for diagnosis reasons
    586. 

  586. }
    587. 

  587.