import wereld.Robot;

public class OefenRobot extends Robot
{
/**
 * De kleur van karel is geel.
 */
    public OefenRobot(String naam)
    {
        super(naam);
        setVulKleur(255,255,0);
    }

    /**
     * Als karel het piepballetje niet heeft, draait hij naar het dobbel getal en loopt vervolgens wat de dobbelWaarde is.
     */
    public void hoofdProgramma(){
        while (!heeftPiepbal()) {
            draaiNaar(dobbelVier() - 1);
            loop (dobbel());
        }
        zeg("Ik heb een piepbal. Nu moet ik hem nog ergens opbergen!");

    }

    /**
     * aantalStappen = Aantal Stappen dat de karel moet maken
     * Als karel voor een obstakel staat, draait hij zich vrij en verft + stapt hij.
     * Als hij de Piepbal niet heeft, maakt hij een stap.
     * Als hij het Piepballetje heeft, pakt hij het en zegt dan vervolgens dat hij het heeft.
     */

    public void loop(int aantalStappen) {
        for (int i = 0 ; i < aantalStappen && !heeftPiepbal(); i++){
            if (!voorObstakel()) {
            draaiVrij();
            verf();
            stap();
            if (opPiepbal()) {
                if (!heeftPiepbal()) {
                    pakPiepbal();
                    zeg("Hebbes dit balletje");
                }
            }
        }
    }
}
/**
 * Verft op positie rood, wit, blauw.
 */
        public void verf() {
        if (pos_y < 7 ) {
            verf(255,0,0);
        } else if (pos_y < 13) {
            verf(255,255,255);
        } else {
            verf(0,0,255);
        }
    }
    /**
     * Deze methode dobbelt tot er een waarde < 5
     * en > 0 gedobbelt is.
     *
     * @return i (int = gedobbelde waarde)
     */
    public int dobbelVier() {
        int i = dobbel();
        while (i > 4) {
            i = dobbel();
        }
        return i;
    }
    /**
     * Als karel niet voor een obstakel staat, word er vier gedobbeld en draait hij naar een positie.
     */
    public void draaiVrij() {
        while (!voorObstakel()) {
            int i = dobbelVier();
            draaiNaar(i -1);
        }
    }
    /**
     * Dit is de kompas functie zodat karel weet waar hij naar toe moet draaien.
     */
    public void draaiNaar(int richting) {
        while (kompas() != richting) {
            rechtsom();
        }
    }
}