#include <gl gl.h=""></gl>

#include "tool.h"

void FlatTool::draw(const Vector3 &pos, const Vector3 &dir) const {

    const int segments = 16;

    const Real len = 10*radius;

    glPushMatrix();

    glEnable(GL_LIGHTING);

    glColor4d(1, 1, 0, 0.25);

    glTranslated(pos.x, pos.y, pos.z);

    Vector3 vx = dir.cross(Vector3(dir.y, dir.z, dir.x));

    vx = vx*(1/vx.len());

    Vector3 vy = vx.cross(dir);

    Real matrix[16] = {

        vx.x,  vx.y,  vx.z,  0,

        vy.x,  vy.y,  vy.z,  0,

        dir.x, dir.y, dir.z, 0,

        0, 0, 0, 1 };

    glMultMatrixd(matrix);

    glBegin(GL_TRIANGLE_STRIP);

    for(int i = 0; i <= segments; ++i) {

        Real a = 2*M_PI*i/segments;

        Real c = cos(a);

        Real s = sin(a);

        glNormal3b(c, s, 0);

        glVertex3d(c*radius, s*radius, 0);

        glVertex3d(c*radius, s*radius, -len);

    }

    glEnd();

    glBegin(GL_TRIANGLE_FAN);

    glNormal3b(0, 0, 1);

    for(int i = 0; i < segments; ++i) {

        Real a = 2*M_PI*i/segments;

        glVertex3d(cos(a)*radius, sin(a)*radius, 0);

    }

    glEnd();

    glBegin(GL_TRIANGLE_FAN);

    glNormal3b(0, 0, -1);

    for(int i = 0; i < segments; ++i) {

        Real a = 2*M_PI*i/segments;

        glVertex3d(cos(a)*radius, sin(a)*radius, -len);

    }

    glEnd();

    glDisable(GL_LIGHTING);

    glPopMatrix();

}