public QuadrupedTelemetrics ReadTelemetrics()
{
List <ServoTelemetrics> servos = new List <ServoTelemetrics>(AllMotorIds.Length);
foreach (var motorId in AllMotorIds)
{
lock (_driver.SyncLock)
{
servos.Add(_driver.GetTelemetrics(motorId));
}
}
return(new QuadrupedTelemetrics {
ServoTelemetrics = servos.OrderBy(servo => servo.Id)
});
}
