File content as of revision 11:2cd6341136ca:

#include "mbed.h"
#include "Rasturizer.h"

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


Rasturizer::Rasturizer(){
    lcd.init();
}

void Rasturizer::drawHorizon(double angle){
    lcd.drawLine(0,
             21,
             84,
             21,
             1);/*
    double floorPoints[14][3] = {{-120,5, 5}, {-120,0, 1000}, {-80,5, 5}, {-80,0, 1000}, {-40,5, 5}, {-40,0, 1000}, {0,5, 5}, {0,0, 1000}, {40,5, 5}, {40,0, 1000}, {80,5, 5}, {80,0, 1000}, {120,5, 5}, {120,0, 1000}};//{-10,20, 10}, {-10,0, 100}, {0,20, 10}, {0,0, 100}, {10,20, 10}, {10,0, 100}, {20,20, 10}, {20,0, 100},{30,20, 10}, {30,0, 100}};
    for(int i = 0; i < 14; i += 2){
        lcd.drawLine(rint(floorPoints[i][0]*(40/floorPoints[i][2]))+42,
                     rint(floorPoints[i][1]*(40/floorPoints[i][2]))+21,
                     rint(floorPoints[i+1][0]*(40/floorPoints[i+1][2]))+42,
                     rint(floorPoints[i+1][1]*(40/floorPoints[i+1][2]))+21,
                     1);
    }*/
}

void Rasturizer::drawFace(Face face, double angle){
    double points[4][3];
    for(int vertex = 0; vertex < 4; vertex++){
        for(int axis = 0; axis < 3; axis++){
            points[vertex][axis] = face.getVertexValue(vertex, axis);
        }
        double y = points[vertex][1];
        double x = points[vertex][0];
        
        points[vertex][0] = x*cos(angle)-y*sin(angle);
        points[vertex][1] = y*cos(angle)+x*sin(angle);
    }
    
    
    if (points[0][2] > 10 || points[1][2] > 10 || points[2][2] > 10|| points[3][2] > 10){
        
        int diffX1 = points[0][0]-points[1][0];
        int diffY1 = points[0][1]-points[1][1];
        int diffX2 = points[2][0]-points[3][0];
        int diffY2 = points[2][1]-points[3][1];
        
        double step = (double)diffY2/(double)diffX2;
        double stepSmall1 = (double)diffX1/(double)diffX2;
        double stepSmall2 = (double)diffY1/(double)diffX2;
        
        for(int s = 0; s<= abs(diffX2)-1; s++){
            lcd.drawLine(rint((points[0][0]-stepSmall1*s)*(40/points[0][2]))+42, rint((points[0][1]-stepSmall2*s)*(40/points[0][2]))+21,rint((points[3][0]+s)*(40/points[3][2]))+42, rint((points[3][1]+step*s)*(40/points[3][2]))+21, 0);
        }
        
        for (int i = 0; i < 3; i++){
            
        lcd.drawLine(rint(points[i][0]*(40/points[i][2]))+42,
                     rint(points[i][1]*(40/points[i][2]))+21,
                     rint(points[i+1][0]*(40/points[i+1][2]))+42,
                     rint(points[i+1][1]*(40/points[i+1][2]))+21,
                     1);
                     
        }
        lcd.drawLine(rint(points[0][0]*(40/points[0][2]))+42,
                     rint(points[0][1]*(40/points[0][2]))+21,
                     rint(points[3][0]*(40/points[3][2]))+42,
                     rint(points[3][1]*(40/points[3][2]))+21,
                     1);
    }
}

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

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

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