/// <summary>
/// メイン
/// </summary>
public override void Drive()
{
bool finish = RArm.DriveParts();
LArm.DriveParts();
if (status == 0)
{
if (finish)
{
status = 1;
RArm.myMotor1.MyMotor.CustomData = "1,90,10";
RArm.myMotor2.MyMotor.CustomData = "1,0,10";
RArm.myMotor3.MyMotor.CustomData = "1,0,10";
RArm.myMotor4.MyMotor.CustomData = "1,0,10";
}
}
else if (status == 1)
{
}
}
public override void Drive()
{
RLeg.DriveParts();
RArm.DriveParts();
LLeg.DriveParts();
LArm.DriveParts();
if (ctrlStatus == Utilty.StatusEnum.Forword)
{
if (RLeg.LegStatus == Utilty.PartsMoveEnum.Move_forward || RLeg.LegStatus == Utilty.PartsMoveEnum.Run_forward)
{
if (RLeg.myMotorKnee.finishFlg && RLeg.myMotorAnkle.finishFlg && RLeg.myMotorThigh.finishFlg)
{
RLeg.LegStatus = Utilty.PartsMoveEnum.Run_Backward;
RLeg.myMotorThigh.MyMotor.CustomData = "1," + TargetListBackward[0] + "," + "30";
RLeg.myMotorKnee.MyMotor.CustomData = "1," + TargetListBackward[1] + "," + "30";
RLeg.myMotorAnkle.MyMotor.CustomData = "1," + TargetListBackward[2] + "," + "5";
LLeg.LegStatus = Utilty.PartsMoveEnum.Move_middle;
LLeg.myMotorThigh.MyMotor.CustomData = "0," + TargetListMiddleward[0] + "," + "30";
LLeg.myMotorKnee.MyMotor.CustomData = "0," + TargetListMiddleward[1] + "," + "50";
LLeg.myMotorAnkle.MyMotor.CustomData = "0," + TargetListMiddleward[2] + "," + "10";
return;
}
}
else if (LLeg.LegStatus == Utilty.PartsMoveEnum.Move_forward || LLeg.LegStatus == Utilty.PartsMoveEnum.Run_forward)
{
if (LLeg.myMotorKnee.finishFlg && LLeg.myMotorAnkle.finishFlg && LLeg.myMotorThigh.finishFlg)
{
LLeg.LegStatus = Utilty.PartsMoveEnum.Run_Backward;
LLeg.myMotorThigh.MyMotor.CustomData = "0," + TargetListBackward[0] + "," + "30";
LLeg.myMotorKnee.MyMotor.CustomData = "0," + TargetListBackward[1] + "," + "30";
LLeg.myMotorAnkle.MyMotor.CustomData = "0," + TargetListBackward[2] + "," + "5";
RLeg.LegStatus = Utilty.PartsMoveEnum.Move_middle;
RLeg.myMotorThigh.MyMotor.CustomData = "1," + TargetListMiddleward[0] + "," + "30";
RLeg.myMotorKnee.MyMotor.CustomData = "1," + TargetListMiddleward[1] + "," + "50";
RLeg.myMotorAnkle.MyMotor.CustomData = "1," + TargetListMiddleward[2] + "," + "10";
return;
}
}
if (LLeg.LegStatus == Utilty.PartsMoveEnum.Move_middle)
{
if (LLeg.myMotorThigh.finishFlg)
{
LLeg.LegStatus = Utilty.PartsMoveEnum.Run_forward;
LLeg.myMotorThigh.MyMotor.CustomData = "0," + TargetListForward[0] + "," + "30";
LLeg.myMotorKnee.MyMotor.CustomData = "0," + TargetListForward[1] + "," + "50";
LLeg.myMotorAnkle.MyMotor.CustomData = "0," + TargetListForward[2] + "," + "50";
}
}
if (RLeg.LegStatus == Utilty.PartsMoveEnum.Move_middle)
{
if (RLeg.myMotorThigh.finishFlg)
{
RLeg.myMotorThigh.MyMotor.CustomData = "1," + TargetListForward[0] + "," + "30";
RLeg.myMotorKnee.MyMotor.CustomData = "1," + TargetListForward[1] + "," + "50";
RLeg.myMotorAnkle.MyMotor.CustomData = "1," + TargetListForward[2] + "," + "50";
RLeg.LegStatus = Utilty.PartsMoveEnum.Run_forward;
}
}
}
else if (ctrlStatus == Utilty.StatusEnum.Halt)
{
if (RLeg.LegStatus == Utilty.PartsMoveEnum.Run_forward)
{
if (RLeg.myMotorKnee.finishFlg && RLeg.myMotorAnkle.finishFlg && RLeg.myMotorThigh.finishFlg)
{
RLeg.LegStatus = Utilty.PartsMoveEnum.Move_Backward;
RLeg.myMotorThigh.MyMotor.CustomData = "1," + TargetListBackward[0] + "," + "10";
RLeg.myMotorKnee.MyMotor.CustomData = "1," + TargetListBackward[1] + "," + "10";
RLeg.myMotorAnkle.MyMotor.CustomData = "1," + TargetListBackward[2] + "," + "5";
LLeg.LegStatus = Utilty.PartsMoveEnum.Move_middle;
LLeg.myMotorThigh.MyMotor.CustomData = "0," + TargetListMiddleward[0] + "," + "10";
LLeg.myMotorKnee.MyMotor.CustomData = "0," + TargetListMiddleward[1] + "," + "30";
LLeg.myMotorAnkle.MyMotor.CustomData = "0," + TargetListMiddleward[2] + "," + "10";
return;
}
}
else if (LLeg.LegStatus == Utilty.PartsMoveEnum.Run_forward)
{
if (LLeg.myMotorKnee.finishFlg && LLeg.myMotorAnkle.finishFlg && LLeg.myMotorThigh.finishFlg)
{
LLeg.LegStatus = Utilty.PartsMoveEnum.Move_Backward;
LLeg.myMotorThigh.MyMotor.CustomData = "0," + TargetListBackward[0] + "," + "10";
LLeg.myMotorKnee.MyMotor.CustomData = "0," + TargetListBackward[1] + "," + "10";
LLeg.myMotorAnkle.MyMotor.CustomData = "0," + TargetListBackward[2] + "," + "5";
RLeg.LegStatus = Utilty.PartsMoveEnum.Move_middle;
RLeg.myMotorThigh.MyMotor.CustomData = "1," + TargetListMiddleward[0] + "," + "10";
RLeg.myMotorKnee.MyMotor.CustomData = "1," + TargetListMiddleward[1] + "," + "30";
RLeg.myMotorAnkle.MyMotor.CustomData = "1," + TargetListMiddleward[2] + "," + "10";
return;
}
}
if (LLeg.LegStatus == Utilty.PartsMoveEnum.Move_middle)
{
if (LLeg.myMotorThigh.finishFlg)
{
LLeg.LegStatus = Utilty.PartsMoveEnum.Move_forward;
LLeg.myMotorThigh.MyMotor.CustomData = "0," + TargetListForward[0] + "," + "30";
LLeg.myMotorKnee.MyMotor.CustomData = "0," + TargetListForward[1] + "," + "50";
LLeg.myMotorAnkle.MyMotor.CustomData = "0," + TargetListForward[2] + "," + "50";
}
}
if (RLeg.LegStatus == Utilty.PartsMoveEnum.Move_middle)
{
if (RLeg.myMotorThigh.finishFlg)
{
RLeg.myMotorThigh.MyMotor.CustomData = "1," + TargetListForward[0] + "," + "30";
RLeg.myMotorKnee.MyMotor.CustomData = "1," + TargetListForward[1] + "," + "50";
RLeg.myMotorAnkle.MyMotor.CustomData = "1," + TargetListForward[2] + "," + "50";
RLeg.LegStatus = Utilty.PartsMoveEnum.Move_forward;
}
}
}
}
/// <summary>
/// メイン
/// </summary>
public override void Drive()
{
RArm.DriveParts();
LArm.DriveParts();
}
