QUYVN/BQP
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

update reconnect imu

Browse Source
This commit is contained in:
QUYVN
2026-07-16 09:55:38 +07:00
parent 921bb91084
commit 0017128218
3 changed files with 21 additions and 21 deletions
Download Patch File Download Diff File Expand all files Collapse all files

12
srcs/RobotNet10/RobotApp/RobotNet10.RobotApp/Drivers/HfiA9IMU/HfiA9IMU.cs
View File

@@ -190,12 +190,12 @@ namespace RobotNet10.RobotApp.Drivers.HfiA9IMU
var ori = CachedOrientation.Vector;
var t = ((IInertialMeasurementUnit)this).LastUpdateTime;
Console.WriteLine(
$"{DateTime.Now:HH:mm:ss.ffffff} [IMU_DATA] " +
$"t={t:HH:mm:ss.fff} " +
$"acc=({acc.X:F3},{acc.Y:F3},{acc.Z:F3}) " +
$"gyro=({gyro.X:F5},{gyro.Y:F5},{gyro.Z:F5}) " +
$"rpy=({ori.X:F5},{ori.Y:F5},{ori.Z:F5})");
// Console.WriteLine(
// $"{DateTime.Now:HH:mm:ss.ffffff} [IMU_DATA] " +
// $"t={t:HH:mm:ss.fff} " +
// $"acc=({acc.X:F3},{acc.Y:F3},{acc.Z:F3}) " +
// $"gyro=({gyro.X:F5},{gyro.Y:F5},{gyro.Z:F5}) " +
// $"rpy=({ori.X:F5},{ori.Y:F5},{ori.Z:F5})");
}
catch { }
}, null, dueTime: TimeSpan.Zero, period: _printDataInterval);