Subversion Repositories scarts

/*

 * Project: AMBA-Modules for SCARTS

 * Author : Martin Luipersbeck

 *

 * Description: Driver for apbvga module

 *

 */

#include "vgatext.h"

#define TO_HEX_CHAR(num) ((num) < 10 ? (num) + 0x30 : (num) + 0x37)

#define TO_DEC_CHAR(num) ((num) + 0x30)

#define CURSOR_MAX 4079

#define CAP_CURSOR(cursor) (cursor) = ((cursor) > CURSOR_MAX ? 0 : (cursor))

#define INC_CURSOR(cursor) (cursor) = ((cursor)++; (cursor) > CURSOR_MAX ? 0 : (cursor))

#define GET_HEX_LETTER(value, index, cursor) (TO_HEX_CHAR((((value)>>((index)*4)) & 0x0F)) + ((cursor)<<8))

void vgatext_initHandle(vgatext_handle_t *h, scarts_addr_t baseAddress)

{

  h->baseAddress = baseAddress;

  h->cursor = 0;

  vgatext_set_fg_color(h, 0, 255, 0);

  vgatext_set_bg_color(h, 0, 0, 0);

  vgatext_clear(h);

}

void vgatext_releaseHandle(vgatext_handle_t *h)

{

}

void vgatext_clear(vgatext_handle_t *h)

{

  uint8_t i, j;

  volatile uint32_t *data;

  data = (uint32_t *)(h->baseAddress+VGATEXT_DATA);

  while(h->cursor < CURSOR_MAX) {

    for(j = 0; j < 80; j++) {

      *data = (uint32_t)((h->cursor<<8) + 0x20);

      h->cursor++;

    }

  }

  h->cursor = 0;

  for(i = 0; i < 36; i++) {

    vgatext_newline(h);

  }

  h->cursor = 0;

}

void vgatext_set_cursor(vgatext_handle_t *h, uint16_t c)

{

  h->cursor = c;

}

void vgatext_newline(vgatext_handle_t *h)

{

  uint8_t j;

  volatile uint32_t *data = (uint32_t *)(h->baseAddress+VGATEXT_DATA);

  h->cursor = h->cursor - h->cursor % 0x50 + 0x50;

  for(j = 0; j < 80; j++) {

    *data = (uint32_t)((h->cursor<<8) + 0x20);

    h->cursor++;

  }

  h->cursor -= 0x50;

  CAP_CURSOR(h->cursor);

}

void vgatext_printByteHex(vgatext_handle_t *h, uint8_t value)

{

  uint8_t out;

  volatile uint32_t *data = (uint32_t *)(h->baseAddress+VGATEXT_DATA);

  out = (value>>4) & 0x0F;

  *data = (uint32_t)(TO_HEX_CHAR(out)) + (uint32_t)(h->cursor<<8);

  h->cursor++;

  CAP_CURSOR(h->cursor);

  out = value & 0x0F;

  *data = (uint32_t)(TO_HEX_CHAR(out)) + (uint32_t)(h->cursor<<8);

  h->cursor++;

  CAP_CURSOR(h->cursor);

}

void vgatext_printIntHex(vgatext_handle_t *h, uint32_t value)

{

  uint8_t i;

  volatile uint32_t *data = (uint32_t *)(h->baseAddress+VGATEXT_DATA);

  for(i = 0; i < 8; i++) {

    *data = GET_HEX_LETTER(value, (7-i), h->cursor);

    h->cursor++;

    CAP_CURSOR(h->cursor);

  }

}

void vgatext_printUInt(vgatext_handle_t *h, uint32_t value)

{

  uint8_t length = 0;

  uint8_t chars[10];

  volatile uint32_t *data = (uint32_t *)(h->baseAddress+VGATEXT_DATA);

  while(length < 10) {

    chars[length] = TO_DEC_CHAR(value % 10);

    length++;

    value /= 10;

    if(value == 0) {

      break;

    }

  }

  while(length > 0) {

    *data = chars[length-1] + (h->cursor<<8);

    length--;

    h->cursor++;

    CAP_CURSOR(h->cursor);

  }

}

void vgatext_print_str(vgatext_handle_t *h, const char* pStr, int length)

{

  uint8_t i = 0;

  volatile uint32_t *data = (uint32_t *)(h->baseAddress+VGATEXT_DATA);

  for(i = 0; i < length; i++) {

    *data = (uint32_t)(pStr[i]) + (uint32_t)(h->cursor<<8);

    h->cursor++;

    CAP_CURSOR(h->cursor);

  }

}

void vgatext_print_char(vgatext_handle_t *h, uint8_t c)

{

  volatile uint32_t *data = (uint32_t *)(h->baseAddress+VGATEXT_DATA);

  *data = (uint32_t)(c) + (uint32_t)(h->cursor<<8);

  h->cursor++;

  CAP_CURSOR(h->cursor);

}

void vgatext_set_fg_color(vgatext_handle_t *h, uint8_t r, uint8_t g, uint8_t b)

{

  volatile uint32_t *data = (uint32_t *)(h->baseAddress+VGATEXT_FG_COLOR);

  uint32_t color = (r << 16) | (g << 8) | b;

  *data = color;

}

void vgatext_set_bg_color(vgatext_handle_t *h, uint8_t r, uint8_t g, uint8_t b)

{

  volatile uint32_t *data = (uint32_t *)(h->baseAddress+VGATEXT_BG_COLOR);

  uint32_t color = (r << 16) | (g << 8) | b;

  *data = color;

}