update AGV.cs 直线行驶
This commit is contained in:
@@ -226,7 +226,7 @@ namespace MultiWheelC
|
|||||||
RightClampTarget = close ? PilotDefinition.Self.RightArmUpperPos : PilotDefinition.Self.RightArmLowerPos
|
RightClampTarget = close ? PilotDefinition.Self.RightArmUpperPos : PilotDefinition.Self.RightArmLowerPos
|
||||||
}.Get()).Wait();
|
}.Get()).Wait();
|
||||||
}
|
}
|
||||||
public void LineTracking(int srcId, int dstId, float LineDistance)
|
public void LineTracking(int srcId, int dstId)
|
||||||
{
|
{
|
||||||
while (!TryLock(dstId))
|
while (!TryLock(dstId))
|
||||||
{
|
{
|
||||||
@@ -235,7 +235,7 @@ namespace MultiWheelC
|
|||||||
DLog.Log($"锁点{dstId}完成", "TireFollowing");
|
DLog.Log($"锁点{dstId}完成", "TireFollowing");
|
||||||
new DriveTask(new LineTracking()
|
new DriveTask(new LineTracking()
|
||||||
{
|
{
|
||||||
Target = LineDistance + (PilotDefinition.Self.LFLActualPos + PilotDefinition.Self.LFRActualPos) / 2,
|
Target = PilotDefinition.Conf.LineTrackDistance + (PilotDefinition.Self.LFLActualPos + PilotDefinition.Self.LFRActualPos) / 2,
|
||||||
LeaveSrcFunction = Leave,
|
LeaveSrcFunction = Leave,
|
||||||
SrcId = srcId,
|
SrcId = srcId,
|
||||||
}.Get()).Wait();
|
}.Get()).Wait();
|
||||||
|
|||||||
Reference in New Issue
Block a user