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[] { 75, 37, 39, -1 }, 50);
      setPosition(new int[] { 68, 39, 30, -1 }, 50);
      setPosition(new int[] { 68, 39, 30, -1 }, 50);
      setPosition(new int[] { 60, 32, 20, -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[] {44, -1, -1, 153 }, 100);
      setPosition(new int[] {60, -1, -1, 164 }, 100);
      setPosition(new int[] {58, -1, -1, 138 }, 100);
      setPosition(new int[] {70, -1, -1, 150 }, 100);
      setPosition(new int[] {60, -1, -1, 170 }, 100);
      setPosition(new int[] {75, -1, -1, 175 }, 100);
      setPosition(new int[] {77, -1, -1, 155 }, 100);
      setPosition(new int[] {83, -1, -1, -1 }, 100);
      setPosition(new int[] {-1, 77, 88, 162 }, 100);
      Arduino.setColor(MainArduino.OFF);
      setPosition(new int[] { -1, 132, -1, -1 }, 250);
      setPosition(new int[] { 87, 153, 138, 92 }, 400);
      setPosition(new int[] { 87, 175, 160, 92 }, 400);

      shutdownServo();
    }
  }
}