ebbits/AdvancedServo-simple/Robots/PaintBot.cs
2015-12-01 15:58:07 +00:00

52 lines
1.9 KiB
C#

using System;
using System.Collections.Generic;
using System.Text;
using ebbits.Arduino;
namespace ebbits.Robots {
class PaintBot : AbstractRobot {
private MainArduino Arduino;
public PaintBot(int id, MainArduino a) {
init(id);
this.cservos = 4;
this.Arduino = a;
base.name = "Paint";
}
public override void run() {
base.startPowerMess();
setStartPosition(new int[] {87, 175, 160, 92 }, 500);
setPosition(new int[] {87, 153, 138, 92 }, 400);
setPosition(new int[] {44, 111, 161, 63 }, 200);
Arduino.setColor(MainArduino.RED);
setPosition(new int[] {90, -1, -1, -1 }, 50);
Arduino.setColor(MainArduino.OFF);
setPosition(new int[] {-1, 140, -1, -1 }, 200);
setPosition(new int[] {-1, 71, 55, 110 }, 200);
setPosition(new int[] {-1, 43, 42, 175 }, 200);
Arduino.setColor(MainArduino.RED);
setPosition(new int[] {60, 33, 22, -1 }, 50);
Arduino.setColor(MainArduino.OFF);
setPosition(new int[] {-1, 63, 45, 150 }, 200);
setPosition(new int[] {50, 68, 76, 132 }, 200);
Arduino.setColor(MainArduino.WHITE);
setPosition(new int[] {-1, -1, -1, 160 }, 100);
setPosition(new int[] {60, -1, -1, 172 }, 100);
setPosition(new int[] {-1, -1, -1, 144 }, 100);
setPosition(new int[] {70, -1, -1, 150 }, 100);
setPosition(new int[] {-1, -1, -1, 175 }, 100);
setPosition(new int[] {80, -1, -1, -1 }, 100);
setPosition(new int[] {-1, -1, -1, 155 }, 100);
setPosition(new int[] {90, 74, 84, 148 }, 100);
setPosition(new int[] {-1, -1, -1, 175 }, 100);
setPosition(new int[] {100, -1, -1, 166 }, 100);
setPosition(new int[] {-1, -1, -1, 146 }, 100);
Arduino.setColor(MainArduino.OFF);
setPosition(new int[] { -1, -1, 100, -1, -1 }, 200);
setPosition(new int[] { 0, 87, 175, 160, 92 }, 400);
shutdownServo();
}
}
}