chonky #670
@ -572,6 +572,8 @@ void AcsBoardPolling::gyroAdisHandler(GyroAdis& gyro) {
|
||||
return;
|
||||
}
|
||||
uint16_t decRateReadBack = (rawReply[10] << 8) | rawReply[11];
|
||||
sif::debug << "AcsPollingTask: DEC rate configuration. Read " << decRateReadBack
|
||||
meggert marked this conversation as resolved
Outdated
|
||||
<< ", expected " << decRate << std::endl;
|
||||
if (decRateReadBack != decRate) {
|
||||
sif::warning << "AcsPollingTask: DEC rate configuration failed. Read " << decRateReadBack
|
||||
<< ", expected " << decRate << std::endl;
|
||||
@ -589,6 +591,7 @@ void AcsBoardPolling::gyroAdisHandler(GyroAdis& gyro) {
|
||||
gyro.performStartup = false;
|
||||
gyro.replyResult = returnvalue::OK;
|
||||
}
|
||||
sif::debug << "hello world 2" << std::endl;
|
||||
// Read regular registers
|
||||
std::memcpy(cmdBuf.data(), adis1650x::BURST_READ_ENABLE.data(),
|
||||
adis1650x::BURST_READ_ENABLE.size());
|
||||
|
@ -26,9 +26,9 @@ void GyrAdis1650XHandler::doStartUp() {
|
||||
breakCountdown.setTimeout(adis1650x::START_UP_TIME);
|
||||
commandExecuted = true;
|
||||
}
|
||||
updatePeriodicReply(true, adis1650x::REPLY);
|
||||
}
|
||||
if (internalState == InternalState::STARTUP_DONE) {
|
||||
updatePeriodicReply(true, adis1650x::REPLY);
|
||||
setMode(MODE_ON);
|
||||
internalState = InternalState::NONE;
|
||||
}
|
||||
|
Loading…
x
Reference in New Issue
Block a user
who did this?