/Users/paul/Documents/phlogo/core/GraphicVerbs.cpp

/*
 *  GraphicVerbs.cpp
 *
 *  Author: Paul Hamilton
 *      Date: 7 Aug 2011
 *
 */
#include "Verbs.h"
        
#include "Interpreter.h"
#include "Thing.h"
#include "Exceptions.h"
#include "World.h"
#include "Turtle.h"

//#include <boost/lexical_cast.hpp>
#include <math.h>

using namespace std;
using namespace boost;

#define PI 3.14159265

namespace phlogo {

// from ArithmeticVerbs
double degToRad(double deg);
    
void Verbs::fd(TokenStream *ts) {
    
    Turtle *t = _world->getTurtle();
        long amount = getLong(ts);
    
    double h = t->getHeading();
    double x2 = t->getX() + ((double)amount * ::sin(h));
    double y2 = t->getY() - ((double)amount * ::sin((PI/2.0)-h));
    
    if (t->getPendown()) {
        t->lineTo(x2, y2);
        t->stroke();
    }
    else {
        t->moveTo(x2, y2);       
    }
    t->setXY(x2, y2);    
    
}
    
void Verbs::bk(TokenStream *ts) {
        
    Turtle *t = _world->getTurtle();
        long amount = getLong(ts);
    
    double h = t->getHeading();
    double x2 = t->getX() - ((double)amount * ::sin(h));
    double y2 = t->getY() + ((double)amount * ::sin((PI/2.0)-h));
    
    if (t->getPendown()) {
        t->lineTo(x2, y2);
        t->stroke();
    }
    else {
        t->moveTo(x2, y2);       
    }

    t->setXY(x2, y2);    
    
}
    
void Verbs::lt(TokenStream *ts) {
    
    Turtle *t = _world->getTurtle();
        long amount = getLong(ts);
    double heading = t->getHeading();
    heading -= degToRad(amount);
    if (heading < 0)
        heading = (PI*2.0) + heading;
    t->setHeading(heading);
    
}

void Verbs::rt(TokenStream *ts) {
    
    Turtle *t = _world->getTurtle();
        long amount = getLong(ts);
    double heading = t->getHeading();
    heading += degToRad(amount);
    if (heading > (PI*2.0))
        heading -= PI*2.0;
    t->setHeading(heading);
                
}
    
void Verbs::repeat(TokenStream *ts) {
    
        long count = getLong(ts);
    
        pThing thing;
        _itp->getNextThing(_world, ts, &thing);
        if (!thing->isList())
                BOOST_THROW_EXCEPTION( no_list_in_thing_exception() );
        
    // we need to build a string back from the args, since that's what our evaluator operates on.
    string s = "";
    for (tListArray::const_iterator i=thing->getList().begin(); i != thing->getList().end(); i++) {
        if (!s.empty())
            s += " ";
        s += (*i)->getWord();
    }
    
    for (int i=0; i<count; i++)
        _itp->runTokenized(_world, s);
}
    
void Verbs::penup(TokenStream *ts) {
    
    _world->getTurtle()->setPendown(false);
}

void Verbs::pendown(TokenStream *ts) {
    
    _world->getTurtle()->setPendown(true);
}

void Verbs::setpos(TokenStream *ts) {
    
        pThing thing;
        _itp->getNextThing(_world, ts, &thing);
        if (!thing->isList())
                BOOST_THROW_EXCEPTION( no_list_in_thing_exception() );
    
    _world->getTurtle()->setXY(thing->getList().get(0)->asLong(), thing->getList().get(1)->asLong());
    
}
    
void Verbs::setxy(TokenStream *ts) {

    _world->getTurtle()->setXY(getLong(ts), getLong(ts));
    
}
    
void Verbs::setx(TokenStream *ts) {
    
    _world->getTurtle()->setXY(getLong(ts), _world->getTurtle()->getY());

}

void Verbs::sety(TokenStream *ts) {
    
    _world->getTurtle()->setXY(_world->getTurtle()->getX(), getLong(ts));
    
}

void Verbs::setheading(TokenStream *ts) {
    
    _world->getTurtle()->setHeading(degToRad(getDouble(ts)));
    
}

void Verbs::home(TokenStream *ts) {
    
    _world->getTurtle()->home();

}

void Verbs::pos(TokenStream *ts) {
    
    pThing t(new Thing());
    List l = t->allocList();
    {
        pThing n(new Thing());
        n->set(_world->getTurtle()->getX());
        l.add(n);
    }
    {
        pThing n(new Thing());
        n->set(_world->getTurtle()->getY());
        l.add(n);
    }
    _world->setResult(t);
}

void Verbs::xcor(TokenStream *ts) {
    
    setDoubleResult(_world->getTurtle()->getX());

}

void Verbs::ycor(TokenStream *ts) {
    
    setDoubleResult(_world->getTurtle()->getY());
    
}

double radToDeg(double rad) {
    return (rad/PI)*180.0;
}

void Verbs::heading(TokenStream *ts) {
    
    setDoubleResult(radToDeg(_world->getTurtle()->getHeading()));
    
}

void Verbs::towards(TokenStream *ts) {
    
        pThing thing;
        _itp->getNextThing(_world, ts, &thing);
        if (!thing->isList())
                BOOST_THROW_EXCEPTION( no_list_in_thing_exception() );
    
    Turtle *t = _world->getTurtle();
    double x1 = t->getX();
    double y1 = t->getY();
    double x2 = thing->getList().get(0)->asDouble();
    double y2 = thing->getList().get(1)->asDouble();

    double deg;
    if (x2 == x1) {
        if (y2 > y1)
            deg = 180;
        else
            deg = 0;
    }
    else if (y2 == y1) {
        if (x2 > x1)
            deg = 90;
        else
            deg = 270;
    }
    else {
        double slope = (x2 - x1) / (y2 - y1);
        if (slope < 0)
            slope *= -1;
        deg = radToDeg(atan(slope)) + (x2 > x1 ? (y2 > y1 ? 90 : 0) : (y2 > y1 ? 180 : 270));
    }
    
    setDoubleResult(deg);
   
}
    
}