Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

AP_Mount: Viewpro fix for date sent from autopilot

This commit is contained in:
Randy Mackay 2023-08-26 10:06:22 +09:00 committed by Andrew Tridgell
parent fe512f7074
commit 6a14c1f72f
1 changed files with 2 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
libraries/AP_Mount/AP_Mount_Viewpro.cpp
View File

@ -672,9 +672,9 @@ bool AP_Mount_Viewpro::send_m_ahrs()
uint16_t year, ms;
uint8_t month, day, hour, min, sec;
if (!AP::rtc().get_date_and_time_utc(year, month, day, hour, min, sec, ms)) {
year = month = day = hour = min = sec = 0;
year = month = day = hour = min = sec = ms = 0;
}
uint16_t date = ((year-2000) & 0x7f) | (((month+1) & 0x0F) << 7) | ((day & 0x0F) << 11);
uint16_t date = ((year-2000) & 0x7f) | (((month+1) & 0x0F) << 7) | ((day & 0x1F) << 11);
uint64_t second_hundredths = (((hour * 60 * 60) + (min * 60) + sec) * 100) + (ms * 0.1);
// get vehicle velocity in m/s in NED Frame