Subversion Repositories Code-Repo

#include <string.h>

#include <stdio.h>

static SSD1306_DATA ssd1306_data;

static SSD1306_DATA *ssd1306_data_p = &ssd1306_data;

#pragma idata LCD_BUFFER

#pragma idata

int SSD1306_Abs(int i) {

    if (i < 0)

        return -i;

        return i;

}

    int tmp = *a;

    *a = *b;

    *b = tmp;

    ssd1306_data_p->_height = ssd1306_data_p->HEIGHT = SSD1306_LCDHEIGHT;

    ssd1306_data_p->rotation = 0;

    ssd1306_data_p->cursor_x = ssd1306_data_p->cursor_y = 0;

    ssd1306_data_p->textsize = 1;

    ssd1306_data_p->textcolor = SSD1306_WHITE;

    ssd1306_data_p->textbgcolor = SSD1306_BLACK;

    ssd1306_data_p->wrap = 1;

void SSD1306_Draw_Line(int x0, int y0, int x1, int y1, unsigned int color) {

    int dx, dy, err, ystep;

    int steep = SSD1306_Abs(y1 - y0) > SSD1306_Abs(x1 - x0);

    if (steep) {

        SSD1306_Swap(&x0, &y0);

        SSD1306_Swap(&x1, &y1);

    }

    if (x0 > x1) {

        SSD1306_Swap(&x0, &x1);

        SSD1306_Swap(&y0, &y1);

    }

    dx = x1 - x0;

    dy = SSD1306_Abs(y1 - y0);

    err = dx / 2;

    if (y0 < y1) {

        ystep = 1;

    } else {

        ystep = -1;

    }

    for (; x0 <= x1; x0++) {

        if (steep) {

            SSD1306_Draw_Pixel(y0, x0, color);

        } else {

            SSD1306_Draw_Pixel(x0, y0, color);

        }

        err -= dy;

        if (err < 0) {

            y0 += ystep;

            err += dx;

        }

    }

}

void SSD1306_Draw_Fast_VLine(int x, int y, int h, unsigned int color) {

    SSD1306_Draw_Line(x, y, x, y + h - 1, color);

}

void SSD1306_Draw_Fast_HLine(int x, int y, int w, unsigned int color) {

    SSD1306_Draw_Line(x, y, x + w - 1, y, color);

}

void SSD1306_Draw_Rect(int x, int y, int w, int h, unsigned int color) {

    SSD1306_Draw_Fast_HLine(x, y, w, color);

    SSD1306_Draw_Fast_HLine(x, y + h, w, color);

    SSD1306_Draw_Fast_VLine(x, y, h, color);

    SSD1306_Draw_Fast_VLine(x + w, y, h, color);

}

void SSD1306_Fill_Rect(int x, int y, int w, int h, unsigned int color) {

    int i;

    for (i = x; i < x + w; i++) {

        SSD1306_Draw_Fast_VLine(i, y, h, color);

    }

}

void SSD1306_Draw_Circle(int x0, int y0, int r, unsigned int color) {

    int f = 1 - r;

    int ddF_x = 1;

    int ddF_y = -2 * r;

    int x = 0;

    int y = r;

    SSD1306_Draw_Pixel(x0, y0 + r, color);

    SSD1306_Draw_Pixel(x0, y0 - r, color);

    SSD1306_Draw_Pixel(x0 + r, y0, color);

    SSD1306_Draw_Pixel(x0 - r, y0, color);

    while (x < y) {

        if (f >= 0) {

            y--;

            ddF_y += 2;

            f += ddF_y;

        }

        x++;

        ddF_x += 2;

        f += ddF_x;

        SSD1306_Draw_Pixel(x0 + x, y0 + y, color);

        SSD1306_Draw_Pixel(x0 - x, y0 + y, color);

        SSD1306_Draw_Pixel(x0 + x, y0 - y, color);

        SSD1306_Draw_Pixel(x0 - x, y0 - y, color);

        SSD1306_Draw_Pixel(x0 + y, y0 + x, color);

        SSD1306_Draw_Pixel(x0 - y, y0 + x, color);

        SSD1306_Draw_Pixel(x0 + y, y0 - x, color);

        SSD1306_Draw_Pixel(x0 - y, y0 - x, color);

    }

}

void SSD1306_Draw_Circle_Helper(int x0, int y0, int r, unsigned char cornername, unsigned int color) {

    int f = 1 - r;

    int ddF_x = 1;

    int ddF_y = -2 * r;

    int x = 0;

    int y = r;

    while (x < y) {

        if (f >= 0) {

            y--;

            ddF_y += 2;

            f += ddF_y;

        }

        x++;

        ddF_x += 2;

        f += ddF_x;

        if (cornername & 0x4) {

            SSD1306_Draw_Pixel(x0 + x, y0 + y, color);

            SSD1306_Draw_Pixel(x0 + y, y0 + x, color);

        }

        if (cornername & 0x2) {

            SSD1306_Draw_Pixel(x0 + x, y0 - y, color);

            SSD1306_Draw_Pixel(x0 + y, y0 - x, color);

        }

        if (cornername & 0x8) {

            SSD1306_Draw_Pixel(x0 - y, y0 + x, color);

            SSD1306_Draw_Pixel(x0 - x, y0 + y, color);

        }

        if (cornername & 0x1) {

            SSD1306_Draw_Pixel(x0 - y, y0 - x, color);

            SSD1306_Draw_Pixel(x0 - x, y0 - y, color);

        }

    }

}

void SSD1306_Fill_Circle(int x0, int y0, int r, unsigned int color) {

    SSD1306_Draw_Fast_VLine(x0, y0 - r, 2 * r + 1, color);

    SSD1306_Fill_Circle_Helper(x0, y0, r, 3, 0, color);

}

void SSD1306_Fill_Circle_Helper(int x0, int y0, int r, unsigned char cornername, int delta, unsigned int color) {

    int f = 1 - r;

    int ddF_x = 1;

    int ddF_y = -2 * r;

    int x = 0;

    int y = r;

    while (x < y) {

        if (f >= 0) {

            y--;

            ddF_y += 2;

            f += ddF_y;

        }

        x++;

        ddF_x += 2;

        f += ddF_x;

        if (cornername & 0x1) {

            SSD1306_Draw_Fast_VLine(x0 + x, y0 - y, 2 * y + 1 + delta, color);

            SSD1306_Draw_Fast_VLine(x0 + y, y0 - x, 2 * x + 1 + delta, color);

        }

        if (cornername & 0x2) {

            SSD1306_Draw_Fast_VLine(x0 - x, y0 - y, 2 * y + 1 + delta, color);

            SSD1306_Draw_Fast_VLine(x0 - y, y0 - x, 2 * x + 1 + delta, color);

        }

    }

}

void SSD1306_Draw_Triangle(int x0, int y0, int x1, int y1, int x2, int y2, unsigned int color) {

    SSD1306_Draw_Line(x0, y0, x1, y1, color);

    SSD1306_Draw_Line(x1, y1, x2, y2, color);

    SSD1306_Draw_Line(x2, y2, x0, y0, color);

}

void SSD1306_Fill_Triangle(int x0, int y0, int x1, int y1, int x2, int y2, unsigned int color) {

    int a, b, y, last;

    int dx01 = x1 - x0;

    int dy01 = y1 - y0;

    int dx02 = x2 - x0;

    int dy02 = y2 - y0;

    int dx12 = x2 - x1;

    int dy12 = y2 - y1;

    int sa = 0;

    int sb = 0;

    // Sort coordinates by Y order (y2 >= y1 >= y0)

    if (y0 > y1) {

        SSD1306_Swap(&y0, &y1);

        SSD1306_Swap(&x0, &x1);

    }

    if (y1 > y2) {

        SSD1306_Swap(&y2, &y1);

        SSD1306_Swap(&x2, &x1);

    }

    if (y0 > y1) {

        SSD1306_Swap(&y0, &y1);

        SSD1306_Swap(&x0, &x1);

    }

    if (y0 == y2) { // Handle awkward all-on-same-line case as its own thing

        a = b = x0;

        if (x1 < a) a = x1;

        else if (x1 > b) b = x1;

        if (x2 < a) a = x2;

        else if (x2 > b) b = x2;

        SSD1306_Draw_Fast_HLine(a, y0, b - a + 1, color);

        return;

    }

    // For upper part of triangle, find scanline crossings for segments

    // 0-1 and 0-2.  If y1=y2 (flat-bottomed triangle), the scanline y1

    // is included here (and second loop will be skipped, avoiding a /0

    // error there), otherwise scanline y1 is skipped here and handled

    // in the second loop...which also avoids a /0 error here if y0=y1

    // (flat-topped triangle).

    if (y1 == y2) last = y1; // Include y1 scanline

    else last = y1 - 1; // Skip it

    for (y = y0; y <= last; y++) {

        a = x0 + sa / dy01;

        b = x0 + sb / dy02;

        sa += dx01;

        sb += dx02;

        /* longhand:

        a = x0 + (x1 - x0) * (y - y0) / (y1 - y0);

        b = x0 + (x2 - x0) * (y - y0) / (y2 - y0);

         */

        if (a > b) SSD1306_Swap(&a, &b);

        SSD1306_Draw_Fast_HLine(a, y, b - a + 1, color);

    }

    // For lower part of triangle, find scanline crossings for segments

    // 0-2 and 1-2.  This loop is skipped if y1=y2.

    sa = dx12 * (y - y1);

    sb = dx02 * (y - y0);

    for (; y <= y2; y++) {

        a = x1 + sa / dy12;

        b = x0 + sb / dy02;

        sa += dx12;

        sb += dx02;

        /* longhand:

        a = x1 + (x2 - x1) * (y - y1) / (y2 - y1);

        b = x0 + (x2 - x0) * (y - y0) / (y2 - y0);

         */

        if (a > b) SSD1306_Swap(&a, &b);

        SSD1306_Draw_Fast_HLine(a, y, b - a + 1, color);

    }

}

void SSD1306_Draw_Round_Rect(int x, int y, int w, int h, int r, unsigned int color) {

    // smarter version

    SSD1306_Draw_Fast_HLine(x + r, y, w - 2 * r, color); // Top

    SSD1306_Draw_Fast_HLine(x + r, y + h - 1, w - 2 * r, color); // Bottom

    SSD1306_Draw_Fast_VLine(x, y + r, h - 2 * r, color); // Left

    SSD1306_Draw_Fast_VLine(x + w - 1, y + r, h - 2 * r, color); // Right

    // draw four corners

    SSD1306_Draw_Circle_Helper(x + r, y + r, r, 1, color);

    SSD1306_Draw_Circle_Helper(x + w - r - 1, y + r, r, 2, color);

    SSD1306_Draw_Circle_Helper(x + w - r - 1, y + h - r - 1, r, 4, color);

    SSD1306_Draw_Circle_Helper(x + r, y + h - r - 1, r, 8, color);

}

void SSD1306_Fill_Round_Rect(int x, int y, int w, int h, int r, unsigned int color) {

    // smarter version

    SSD1306_Fill_Rect(x + r, y, w - 2 * r, h, color);

    // draw four corners

    SSD1306_Fill_Circle_Helper(x + w - r - 1, y + r, r, 1, h - 2 * r - 1, color);

    SSD1306_Fill_Circle_Helper(x + r, y + r, r, 2, h - 2 * r - 1, color);

}

void SSD1306_Draw_Bitmap(int x, int y, const unsigned char* bitmap, int w, int h, unsigned int color) {

    int i, j;

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

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

            if (bitmap[i + (j / 8) * w] & (j % 8)) {

                SSD1306_Draw_Pixel(x + i, y + j, color);

            }

        }

    }

}

void SSD1306_Draw_Char(int x, int y, unsigned char c, unsigned int color, unsigned int bg, unsigned char size) {

    int i, j;

    unsigned int line;

    if ((x >= ssd1306_data_p->_width) || // Clip right

            (y >= ssd1306_data_p->_height) || // Clip bottom

            ((x + 5 * size - 1) < 0) || // Clip left

            ((y + 8 * size - 1) < 0)) // Clip top

        return;

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

        if (i == 5)

            line = 0x0;

        else

            line = font[(c * 5) + i];

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

            if (line & 0x1) {

                if (size == 1) {// default size

                    SSD1306_Draw_Pixel(x + i, y + j, color);

                } else { // big size

                    SSD1306_Fill_Rect(x + (i * size), y + (j * size), size, size, color);

                }

            } else if (bg != color) {

                if (size == 1) { // default size

                    SSD1306_Draw_Pixel(x + i, y + j, bg);

                } else { // big size

                    SSD1306_Fill_Rect(x + i*size, y + j*size, size, size, bg);

                }

            }

            line >>= 1;

        }

    }

}

void SSD1306_Write(unsigned char c) {

    if (c == '\n' || c == '\r') {

        ssd1306_data_p->cursor_y += ssd1306_data_p->textsize * 8;

        ssd1306_data_p->cursor_x = 0;

        //    } else if (c == '\r') {

        //        // skip em

    } else {

        SSD1306_Draw_Char(ssd1306_data_p->cursor_x, ssd1306_data_p->cursor_y, c, ssd1306_data_p->textcolor, ssd1306_data_p->textbgcolor, ssd1306_data_p->textsize);

        ssd1306_data_p->cursor_x += ssd1306_data_p->textsize * 6;

        if (ssd1306_data_p->wrap && (ssd1306_data_p->cursor_x > (ssd1306_data_p->_width - ssd1306_data_p->textsize * 6))) {

            ssd1306_data_p->cursor_y += ssd1306_data_p->textsize * 8;

            ssd1306_data_p->cursor_x = 0;

        }

    }

}

void SSD1306_Write_String(const rom char *fmt, ...) {

    unsigned char i, len;

    unsigned char buffer[SSD1306_STRING_BUFFER_SIZE];

    // Parse and create string

    va_list args;

    va_start(args, fmt);

    vsprintf((char *) buffer, fmt, args);

    va_end(args);

    len = strlen((char *) buffer);

    // Make sure string to insert fits in buffer, truncate if necessary

    if (len > SSD1306_STRING_BUFFER_SIZE)

        len = SSD1306_STRING_BUFFER_SIZE;

    // Print buffer to string

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

        SSD1306_Write(buffer[i]);

    }

}

//void SSD1306_Append_String(const rom char *fmt, ...) {

//    unsigned char i, len;

//    unsigned char buffer[SSD1306_STRING_BUFFER_SIZE];

//

//    // Parse and create string

//    va_list args;

//    va_start(args, fmt);

//    vsprintf((char *) buffer, fmt, args);

//    va_end(args);

//

//    // Make sure string to insert fits in buffer, truncate if necessary

//    len = strlen((char *) buffer);

//

//    if (len == 1) {  // This will only occur on "\n"

//        // Do nothing?

//        return;

//    }

//

//    if (len > SSD1306_STRING_BUFFER_SIZE)

//        len = SSD1306_STRING_BUFFER_SIZE;

//

//    // Omit the newline if string fill entire line

//    if (((len - 1)%(ssd1306_data_p->_width / 6)) == 0) { // 16 or 10

//        len -= 1;

//    }

//

//    // Shift everything right and insert string at beginning

//    for (i = 127; i > len - 1; i--) {

//        ssd1306_data_p->lcd_buffer[i] = ssd1306_data_p->lcd_buffer[i - len];

//    }

//    memcpy((char *)ssd1306_data_p->lcd_buffer, (const char *) buffer, len);

//

//    // Print full buffer to screen

//    SSD1306_Clear_Display();

//    SSD1306_Display();

//

//    SSD1306_Set_Cursor(0,0);

//    for (i = 0; i < SSD1306_LCD_BUFFER_SIZE-1; i++) {

//        SSD1306_Write(ssd1306_data_p->lcd_buffer[i]);

//    }

//}

void SSD1306_Set_Cursor(int x, int y) {

    ssd1306_data_p->cursor_x = x;

    ssd1306_data_p->cursor_y = y;

}

void SSD1306_Set_Text_Color(unsigned int c) {

    // for 'transparent' background, we'll set the bg

    // to the same as fg instead of using a flag

    ssd1306_data_p->textcolor = c;

    ssd1306_data_p->textbgcolor = c;

}

void SSD1306_Set_Text_Color_BG(unsigned int c, unsigned int bg) {

    ssd1306_data_p->textcolor = c;

    ssd1306_data_p->textbgcolor = bg;

}

void SSD1306_Set_Text_Size(unsigned char s) {

    ssd1306_data_p->textsize = (s > 0) ? s : 1;

}

void SSD1306_Set_Text_Wrap(unsigned char w) {

    ssd1306_data_p->wrap = w;

}

void SSD1306_Set_Rotation(unsigned char x) {

    x %= 4; // cant be higher than 3

    ssd1306_data_p->rotation = x;

    switch (x) {

        case 0:

        case 2:

            ssd1306_data_p->_width = ssd1306_data_p->WIDTH;

            ssd1306_data_p->_height = ssd1306_data_p->HEIGHT;

            break;

        case 1:

        case 3:

            ssd1306_data_p->_width = ssd1306_data_p->HEIGHT;

            ssd1306_data_p->_height = ssd1306_data_p->WIDTH;

            break;

    }

}