File content as of revision 20:3ca430241df0:

#include "Rasturizer.h"


N5110 lcd(PTC9,PTC0,PTC7,PTD2,PTD1,PTC11);

Rasturizer::Rasturizer(){
    for(int i = 0; i < 6; i++){
        selectionCube.getFace(i).setVisible(true);
    }
}


void Rasturizer::init(){
    lcd.init();
    fov = 50;
}

float Rasturizer::xTo2D(float x, float z){
    return x * (fov/z) + 42;
}

float Rasturizer::yTo2D(float y, float z){
    return y * (fov/z) + 21;
}

void Rasturizer::drawHorizon(float angle){
    lcd.drawLine(0,
             21-rint(angle*50),
             84,
             21+rint(angle*50),
             1);
}

void Rasturizer::drawFace(Face face, float angle){
    float points[4][3];
    for(int vertex = 0; vertex < 4; vertex++){
        for(int axis = 0; axis < 3; axis++){
            points[vertex][axis] = face.getVertexValue(vertex, axis);
        }
        float y = points[vertex][1];
        float x = points[vertex][0];
        
        points[vertex][0] = x*cos(angle)-y*sin(angle);
        points[vertex][1] = y*cos(angle)+x*sin(angle);
    }
    
    if (checkOnScreen(points) && face.getVisible()){
        int diffX1 = xTo2D(points[0][0], points[0][2])-xTo2D(points[1][0], points[1][2]);
        int diffY1 = yTo2D(points[0][1], points[0][2])-yTo2D(points[1][1], points[1][2]);
        int diffX2 = xTo2D(points[2][0], points[2][2])-xTo2D(points[3][0], points[3][2]);
        int diffY2 = yTo2D(points[2][1], points[2][2])-yTo2D(points[3][1], points[3][2]);
        
        float step = (float)diffY2/(float)diffX2;
        float stepSmall1 = (float)diffX1/(float)diffX2;
        float stepSmall2 = (float)diffY1/(float)diffX2;
        
        for(int s = 0; s< abs(diffX2); s++){
            if(diffX2 > 0){
                lcd.drawLine(rint(xTo2D(points[0][0], points[0][2])-stepSmall1*s),//rint((points[0][0])*(40/points[0][2])-stepSmall1*s)+42,
                    rint(yTo2D(points[0][1], points[0][2])-stepSmall2*s),
                    rint(xTo2D(points[3][0], points[3][2])+s), 
                    rint(yTo2D(points[3][1], points[3][2])+step*s),
                    0);
            }
            else{
                lcd.drawLine(rint(xTo2D(points[0][0], points[0][2])+stepSmall1*s),//rint((points[0][0])*(40/points[0][2])-stepSmall1*s)+42,
                    rint(yTo2D(points[0][1], points[0][2])+stepSmall2*s),
                    rint(xTo2D(points[3][0], points[3][2])-s), 
                    rint(yTo2D(points[3][1], points[3][2])-step*s),
                    0);
            }
        }
    }
    if((points[0][2] > 10 || points[1][2] > 10 || points[2][2] > 10|| points[3][2] > 10)){
        for (int i = 0; i < 3; i++){     
            lcd.drawLine(rint(xTo2D(points[i][0], points[i][2])),
                rint(yTo2D(points[i][1], points[i][2])),
                rint(xTo2D(points[i+1][0], points[i+1][2])),
                rint(yTo2D(points[i+1][1], points[i+1][2])),
                1);
        }
        lcd.drawLine(rint(xTo2D(points[0][0], points[0][2])),
            rint(yTo2D(points[0][1], points[0][2])),
            rint(xTo2D(points[3][0], points[3][2])),
            rint(yTo2D(points[3][1], points[3][2])),
            1);
    }
}
void Rasturizer::drawAllFaces(Face faceArray[], int noOfCubes, float angle){
    for (int f = 0; f< (noOfCubes*6)-1; f++){
        for (int f2 = 0; f2< (noOfCubes*6)-f-1; f2++){
            if(faceArray[f2].getAvgZ() < faceArray[f2+1].getAvgZ()){
                Face temp = faceArray[f2+1];
                faceArray[f2+1] = faceArray[f2];
                faceArray[f2] = temp;
            }
        }
    }
    for (int f = 0; f< noOfCubes*6 ; f++){
        drawFace(faceArray[f], angle/15);
    }
}

bool Rasturizer::checkOnScreen(float (&points)[4][3]){
    if (points[0][2] < 10 || points[1][2] < 10 || points[2][2] < 10 || points[3][2] < 10){
        return false;
    }
    else if ((xTo2D(points[0][0], points[0][2]) < 0 ||  xTo2D(points[0][0], points[0][2]) > 84)
    && (xTo2D(points[1][0], points[1][2]) < 0 ||  xTo2D(points[1][0], points[1][2]) > 84)
    && (xTo2D(points[2][0], points[2][2]) < 0 ||  xTo2D(points[2][0], points[2][2]) > 84)
    && (xTo2D(points[3][0], points[3][2]) < 0 ||  xTo2D(points[3][0], points[3][2]) > 84)){
        return false;
    }
    return true;
}

void Rasturizer::print(const char *text, int x, int y){
    lcd.printString(text, x, y);
}

void Rasturizer::clear(){
    lcd.clear();
}

void Rasturizer::refresh(){
    lcd.refresh();
}

void Rasturizer::drawDeathScreen(bool selection){
    Face faces[6];
    int x;
    int y;
    int z;
    
    if(selection == true){
        x = -30;
        y = -3;
        z = 50;
    }
    else{
        x = -30;
        y = 15;
        z = 50;
    }
    
    lcd.drawRect(24, 14, 45, 11, FILL_WHITE);
    lcd.drawRect(24, 14, 45, 11, FILL_TRANSPARENT);
    lcd.printString("Restart",26,2);
    lcd.drawRect(24, 30, 45, 11, FILL_WHITE);
    lcd.drawRect(24, 30, 45, 11, FILL_TRANSPARENT);
    lcd.printString("Menu",35,4);
    selectionCube.translate(x, y, z);
    for(int i = 0; i < 6; i++){
        faces[i] = selectionCube.getFace(i);
    }
    drawAllFaces(faces, 1, 0);
    selectionCube.rotateX(0.1);
    selectionCube.rotateY(0.05);
    selectionCube.rotateZ(-0.08);
    selectionCube.translate(-x, -y, -z);
}

void Rasturizer::drawHomeScreen(int selection){
    Face faces[6];
    int x;
    int y;
    int z;
    
    if(selection == 0){
        x = -30;
        y = -12;
        z = 50;
    }
    else if(selection == 1){
        x = -30;
        y = 5;
        z = 50;
    }
    else{
        x = -30;
        y = 22;
        z = 50;
    }
    
    lcd.drawRect(24, 6, 45, 10, FILL_WHITE);
    lcd.printString("Play",35,1);
    lcd.drawRect(24, 6, 45, 10, FILL_TRANSPARENT);

    lcd.drawRect(24, 22, 45, 10, FILL_WHITE);
    lcd.printString("Help",35,3);
    lcd.drawRect(24, 22, 45, 10, FILL_TRANSPARENT);

    
    lcd.drawRect(24, 38, 45, 10, FILL_WHITE);
    lcd.printString("Quit",35,5);
    lcd.drawRect(24, 38, 45, 10, FILL_TRANSPARENT);
    selectionCube.translate(x, y, z);
    
    for(int i = 0; i < 6; i++){
        faces[i] = selectionCube.getFace(i);
    }
    drawAllFaces(faces, 1, 0);
    selectionCube.rotateX(-0.1);
    selectionCube.rotateY(-0.05);
    selectionCube.rotateZ(0.08);
    selectionCube.translate(-x, -y, -z);
}