Skip to content
Merged
Show file tree
Hide file tree
Changes from all commits
Commits
File filter

Filter by extension

Filter by extension

Conversations
Failed to load comments.
Loading
Jump to
Jump to file
Failed to load files.
Loading
Diff view
Diff view
5 changes: 3 additions & 2 deletions .config/dotnet-tools.json
Original file line number Diff line number Diff line change
Expand Up @@ -3,10 +3,11 @@
"isRoot": true,
"tools": {
"csharpier": {
"version": "0.28.1",
"version": "0.30.6",
"commands": [
"dotnet-csharpier"
]
],
"rollForward": false
}
}
}
Original file line number Diff line number Diff line change
Expand Up @@ -295,11 +295,12 @@ public async Awaitable<bool> MoveByWorldSpaceDelta(Vector4 worldSpaceDelta)
);
if (CommunicationManager.HasError(setPositionResponse.Error))
return false;

// 3-axis manipulators need to set depth separately if requested.

if (NumAxes != 3) return true;

if (NumAxes != 3)
return true;

// Process depth movement after regular movement.
var targetDepth = setPositionResponse.Position.w + manipulatorSpaceDepthDelta;

Expand Down
Original file line number Diff line number Diff line change
Expand Up @@ -39,7 +39,7 @@ public async Awaitable<bool> ResetDuraOffset()
var positionResponse = await CommunicationManager.Instance.GetPosition(ManipulatorID);
if (CommunicationManager.HasError(positionResponse.Error))
return false;

// Save the Dura's position.
_duraDepth = positionResponse.Position.w;

Expand Down Expand Up @@ -79,7 +79,7 @@ public async Awaitable<bool> ResetDuraOffset()

// Save the probe's coordinates at the Dura.
_duraCoordinate = _probeController.Insertion.APMLDV;

// Log the event.
OutputLog.Log(
new[]
Expand All @@ -88,7 +88,7 @@ public async Awaitable<bool> ResetDuraOffset()
DateTime.Now.ToString(CultureInfo.InvariantCulture),
"ResetDuraOffset",
ManipulatorID,
BrainSurfaceOffset.ToString(CultureInfo.InvariantCulture)
(BrainSurfaceOffset * 1000).ToString(CultureInfo.InvariantCulture),
}
);

Expand Down
Original file line number Diff line number Diff line change
Expand Up @@ -202,7 +202,7 @@ public async void StopInsertion()
DateTime.Now.ToString(CultureInfo.InvariantCulture),
"Drive",
ManipulatorID,
"Stop"
"Stop",
}
);
}
Expand Down Expand Up @@ -358,9 +358,9 @@ private void LogDriveToTargetInsertion(
"DriveToTargetInsertion",
ManipulatorID,
ProbeAutomationStateManager.ProbeAutomationState.ToString(),
targetDepth.ToString(CultureInfo.InvariantCulture),
baseSpeed.ToString(CultureInfo.InvariantCulture),
drivePastDistance.ToString(CultureInfo.InvariantCulture)
(targetDepth * 1000).ToString(CultureInfo.InvariantCulture),
(baseSpeed * 1000).ToString(CultureInfo.InvariantCulture),
(drivePastDistance * 1000).ToString(CultureInfo.InvariantCulture),
}
);
}
Expand Down Expand Up @@ -453,32 +453,32 @@ float drivePastDistance
// Compute ETA.
var secondsToDestination = ProbeAutomationStateManager.ProbeAutomationState switch
{
ProbeAutomationState.DrivingToNearTarget
=> Mathf.Max(0, distanceToTarget - NEAR_TARGET_DISTANCE) / baseSpeed // To near target.
+ (NEAR_TARGET_DISTANCE + 2 * drivePastDistance)
/ (baseSpeed * NEAR_TARGET_SPEED_MULTIPLIER), // To past target and back to target.
ProbeAutomationState.DrivingToPastTarget
=> (distanceToTarget + 2 * drivePastDistance)
ProbeAutomationState.DrivingToNearTarget => Mathf.Max(
0,
distanceToTarget - NEAR_TARGET_DISTANCE
) / baseSpeed // To near target.
+ (NEAR_TARGET_DISTANCE + 2 * drivePastDistance)
/ (baseSpeed * NEAR_TARGET_SPEED_MULTIPLIER), // To past target and back to target.
ProbeAutomationState.ReturningToTarget
=> distanceToTarget / (baseSpeed * NEAR_TARGET_SPEED_MULTIPLIER), // Back to target.
ProbeAutomationState.ExitingToDura
=> (GetTargetDistanceToDura(targetInsertionProbeManager) - distanceToTarget)
/ (baseSpeed * EXIT_DRIVE_SPEED_MULTIPLIER) // To Dura.
+ DURA_MARGIN_DISTANCE / (baseSpeed * EXIT_DRIVE_SPEED_MULTIPLIER) // To exit margin.
+ _actualExitMarginToDuraDistance / AUTOMATIC_MOVEMENT_SPEED, // To entry coordinate.
ProbeAutomationState.ExitingToMargin
=> (
DURA_MARGIN_DISTANCE
- (distanceToTarget - GetTargetDistanceToDura(targetInsertionProbeManager))
) / (baseSpeed * EXIT_DRIVE_SPEED_MULTIPLIER) // To exit margin.
+ _actualExitMarginToDuraDistance / AUTOMATIC_MOVEMENT_SPEED, // To entry coordinate.
ProbeAutomationState.ExitingToTargetEntryCoordinate
=> (
IDEAL_ENTRY_COORDINATE_TO_DURA_DISTANCE
- (distanceToTarget - GetTargetDistanceToDura(targetInsertionProbeManager))
) / AUTOMATIC_MOVEMENT_SPEED,
_ => 0
ProbeAutomationState.DrivingToPastTarget => (
distanceToTarget + 2 * drivePastDistance
) / (baseSpeed * NEAR_TARGET_SPEED_MULTIPLIER), // To past target and back to target.
ProbeAutomationState.ReturningToTarget => distanceToTarget
/ (baseSpeed * NEAR_TARGET_SPEED_MULTIPLIER), // Back to target.
ProbeAutomationState.ExitingToDura => (
GetTargetDistanceToDura(targetInsertionProbeManager) - distanceToTarget
) / (baseSpeed * EXIT_DRIVE_SPEED_MULTIPLIER) // To Dura.
+ DURA_MARGIN_DISTANCE / (baseSpeed * EXIT_DRIVE_SPEED_MULTIPLIER) // To exit margin.
+ _actualExitMarginToDuraDistance / AUTOMATIC_MOVEMENT_SPEED, // To entry coordinate.
ProbeAutomationState.ExitingToMargin => (
DURA_MARGIN_DISTANCE
- (distanceToTarget - GetTargetDistanceToDura(targetInsertionProbeManager))
) / (baseSpeed * EXIT_DRIVE_SPEED_MULTIPLIER) // To exit margin.
+ _actualExitMarginToDuraDistance / AUTOMATIC_MOVEMENT_SPEED, // To entry coordinate.
ProbeAutomationState.ExitingToTargetEntryCoordinate => (
IDEAL_ENTRY_COORDINATE_TO_DURA_DISTANCE
- (distanceToTarget - GetTargetDistanceToDura(targetInsertionProbeManager))
) / AUTOMATIC_MOVEMENT_SPEED,
_ => 0,
};

// Return formatted time if above 1 minute.
Expand Down
Original file line number Diff line number Diff line change
Expand Up @@ -81,7 +81,7 @@ when Mathf.Abs(Dimensions.z / 2f - positionalResponse.Position.w)
DateTime.Now.ToString(CultureInfo.InvariantCulture),
"ResetReferenceCoordinate",
ManipulatorID,
ReferenceCoordinateOffset.ToString()
(ReferenceCoordinateOffset * 1000).ToString(),
}
);
return true;
Expand Down
Original file line number Diff line number Diff line change
Expand Up @@ -124,7 +124,7 @@ public async Awaitable<bool> DriveToTargetEntryCoordinate()
DateTime.Now.ToString(CultureInfo.InvariantCulture),
"DriveToTargetEntryCoordinate",
ManipulatorID,
"Start"
"Start",
}
);

Expand Down Expand Up @@ -283,15 +283,15 @@ private void CreateTrajectoryLines()
var defaultSpriteShader = Shader.Find("Sprites/Default");
_trajectoryLineLineRenderers.ap.material = new Material(defaultSpriteShader)
{
color = AP_COLOR
color = AP_COLOR,
};
_trajectoryLineLineRenderers.ml.material = new Material(defaultSpriteShader)
{
color = ML_COLOR
color = ML_COLOR,
};
_trajectoryLineLineRenderers.dv.material = new Material(defaultSpriteShader)
{
color = DV_COLOR
color = DV_COLOR,
};

// Set line widths.
Expand Down Expand Up @@ -376,7 +376,7 @@ private void LogDriveToTargetEntryCoordinateProgress(string progressMessage)
DateTime.Now.ToString(CultureInfo.InvariantCulture),
"DriveToTargetEntryCoordinate",
ManipulatorID,
progressMessage
progressMessage,
}
);
}
Expand Down
Original file line number Diff line number Diff line change
Expand Up @@ -27,7 +27,7 @@ public async Awaitable<bool> MoveBackToReferenceCoordinate()
DateTime.Now.ToString(CultureInfo.InvariantCulture),
"MoveBackToReferenceCoordinate",
ManipulatorID,
"Start"
"Start",
}
);

Expand All @@ -51,7 +51,7 @@ public async Awaitable<bool> MoveBackToReferenceCoordinate()
DateTime.Now.ToString(CultureInfo.InvariantCulture),
"MoveBackToReferenceCoordinate",
ManipulatorID,
"End"
"End",
}
);

Expand Down Expand Up @@ -83,7 +83,7 @@ public async void StopReturnToReferenceCoordinate()
DateTime.Now.ToString(CultureInfo.InvariantCulture),
"MoveBackToReferenceCoordinate",
ManipulatorID,
"Stop"
"Stop",
}
);
}
Expand Down