#include <VGA.h>

#include <PS2Keyboard.h>

const int DataPin = 8;
const int IRQpin =  5;

PS2Keyboard keyboard;

#define w 1024
#define h 675
#define P "(with PS2Keyboard lib, v2.4)"
#define S "Sierpinski triangle"
#define T "1024 x 675  DueVGA lib"

int x,y,state;
long last;

void setup() {
  unsigned char L[2][h];
  int n,k,o=0;
  
  //keyboard.begin(DataPin, IRQpin, PS2Keymap_US);
  keyboard.begin(DataPin, IRQpin, PS2Keymap_German);
  //keyboard.begin(DataPin, IRQpin, PS2Keymap_French);

  x=y=0;
  
  VGA.begin(w,h);
  
  for(n=0; n<h; ++n, o=1-o) {
    L[1-o][0]=L[1-o][n]=1; 
    for(k=1; k<n; ++k) { L[1-o][k]=L[o][k-1]+L[o][k]; }
    for(k=0; k<=n; ++k) { 
      VGA.drawPixel(w/2-n+2*k,n,(L[1-o][k]%2)!=0);
    }
  }
  
  drawText32(P,w/2-16*strlen(P),h-128);
  drawText32(T,w/2-16*strlen(T),h-64);
  drawText32(S,w/2-16*strlen(S),h-32);

  last=millis(); state=0;
  drawCursor32(x,y,state);    
}

void loop() {
  if (keyboard.available()) {
    char c = keyboard.read();
    if (c == PS2_ENTER) {
      if (state)
        drawCursor32(x,y,state);
      y+=32; x=0;
    } else if (c == PS2_BACKSPACE) {
      if (x > 0) {
        char s[]=" ";
        if (state)
          drawCursor32(x,y,state);
        x-=32;
        drawText32(s,x,y);
      }  
    } else if (c == PS2_LEFTARROW) {
      if (x > 0) {
        if (state)
          drawCursor32(x,y,state);
        x-=32;
      }  
    } else if (c == PS2_RIGHTARROW) {
      if (x < 992) {
        if (state)
          drawCursor32(x,y,state);
        x+=32;
      }  
    } else if (c == PS2_UPARROW) {
      if (y > 0) {
        if (state)
          drawCursor32(x,y,state);
        y-=32;
      }  
    } else if (c == PS2_DOWNARROW) {
      if (y < 640) {
        if (state)
          drawCursor32(x,y,state);
        y+=32;
      }  
    } else {
      char s[]={c,0};
      drawText32(s,x,y);
      x+=32;
    }
  }
  else 
  {
    if (millis()-last > 500) 
    {
      drawCursor32(x,y,state);
      last=millis();
    }  
  }
}

void drawCursor32(int x, int y, int& s)
{
  int i,j;
  s = 1-s;
  for(i=x; i<x+32; ++i)
    for(j=y; j<y+32; ++j)
      VGA.putPPixelFast(i,j,1-VGA.getPPixelFast(i,j));
}

void drawText32(char *text, int x, int y)
{
  uint8_t t;
  while(t=(uint8_t)*text++){
    for(int j=0;j<8;j++)for(int i=0;i<8;i++){
      bool p=(_vga_font8x8[8*t+j]&(128>>i))!=0;
      for(int a=0; a<4; ++a)for(int b=0; b<4; ++b) {
        VGA.drawPixel(x+4*i+a,y+4*j+b,p);
      }
    }
    x+=32;  
  }
}