diff options
| author | gdisirio <gdisirio@35acf78f-673a-0410-8e92-d51de3d6d3f4> | 2013-02-12 08:47:41 +0000 |
|---|---|---|
| committer | gdisirio <gdisirio@35acf78f-673a-0410-8e92-d51de3d6d3f4> | 2013-02-12 08:47:41 +0000 |
| commit | 0c9df1d3fdc7e935447e0c4a483e41adc6d59b7d (patch) | |
| tree | ac9dc9ff7bd658d719627d590f3b49c260920b74 /os/hal/platforms/SPC56ELxx/hal_lld.c | |
| parent | 095677dfa38209f79c8541a5129d75b268faf337 (diff) | |
| download | ChibiOS-0c9df1d3fdc7e935447e0c4a483e41adc6d59b7d.tar.gz ChibiOS-0c9df1d3fdc7e935447e0c4a483e41adc6d59b7d.tar.bz2 ChibiOS-0c9df1d3fdc7e935447e0c4a483e41adc6d59b7d.zip | |
git-svn-id: svn://svn.code.sf.net/p/chibios/svn/trunk@5155 35acf78f-673a-0410-8e92-d51de3d6d3f4
Diffstat (limited to 'os/hal/platforms/SPC56ELxx/hal_lld.c')
| -rw-r--r-- | os/hal/platforms/SPC56ELxx/hal_lld.c | 18 |
1 files changed, 11 insertions, 7 deletions
diff --git a/os/hal/platforms/SPC56ELxx/hal_lld.c b/os/hal/platforms/SPC56ELxx/hal_lld.c index f3ba51399..2bf7a1656 100644 --- a/os/hal/platforms/SPC56ELxx/hal_lld.c +++ b/os/hal/platforms/SPC56ELxx/hal_lld.c @@ -128,7 +128,6 @@ void spc_early_init(void) { #endif /* SPC5_OSC_BYPASS */
/* Setting the various dividers and source selectors.*/
- CGM.SC_SS.R = SPC5_CGM_SC_SS;
CGM.SC_DC0.R = SPC5_CGM_SC_DC0;
/*CGM.AC0_DC0_3.R = 0x80808080;
@@ -210,16 +209,21 @@ void spc_early_init(void) { */
bool_t halSPCSetRunMode(spc5_runmode_t mode) {
+ /* Clearing status register bits I_IMODE(4) and I_IMTC(1).*/
+ ME.IS.R = 5;
+
/* Starts a transition process.*/
ME.MCTL.R = SPC5_ME_MCTL_MODE(mode) | SPC5_ME_MCTL_KEY;
ME.MCTL.R = SPC5_ME_MCTL_MODE(mode) | SPC5_ME_MCTL_KEY_INV;
- /* Waits for the mode switch.
- TODO: Check for errors during the switch procedure.*/
- while (ME.GS.B.S_CURRENT_MODE != mode)
- ;
-
- return CH_SUCCESS;
+ /* Waits for the mode switch.*/
+ while (TRUE) {
+ uint32_t r = ME.IS.R;
+ if (r & 1)
+ return CH_SUCCESS;
+ if (r & 4)
+ return CH_FAILED;
+ }
}
/**
|