From 3cd053218f7174761eed9da1fd32a71ebdef5978 Mon Sep 17 00:00:00 2001 From: iceman1001 Date: Thu, 17 Oct 2019 20:08:17 +0200 Subject: [PATCH] chg: wait until ready --- armsrc/appmain.c | 4 ++++ 1 file changed, 4 insertions(+) diff --git a/armsrc/appmain.c b/armsrc/appmain.c index b073598b2..3b6976819 100644 --- a/armsrc/appmain.c +++ b/armsrc/appmain.c @@ -1899,9 +1899,13 @@ static void PacketReceived(PacketCommandNG *packet) { break; } case CMD_TIA: { + + while ((AT91C_BASE_PMC->PMC_MCFR & AT91C_CKGR_MAINRDY) == 0); // Wait for MAINF value to become available... uint16_t mainf = AT91C_BASE_PMC->PMC_MCFR & AT91C_CKGR_MAINF; Dbprintf(" Slow clock old measured value:.........%d Hz", (16 * MAINCK) / mainf); TimingIntervalAcquisition(); + + while ((AT91C_BASE_PMC->PMC_MCFR & AT91C_CKGR_MAINRDY) == 0); // Wait for MAINF value to become available... mainf = AT91C_BASE_PMC->PMC_MCFR & AT91C_CKGR_MAINF; Dbprintf(""); // first message gets lost Dbprintf(" Slow clock new measured value:.........%d Hz", (16 * MAINCK) / mainf);