Subversion Repositories freemyipod

//

//

//    Copyright 2011 TheSeven

//

//

//    This file is part of emCORE.

//

//    emCORE is free software: you can redistribute it and/or

//    modify it under the terms of the GNU General Public License as

//    published by the Free Software Foundation, either version 2 of the

//    License, or (at your option) any later version.

//

//    emCORE is distributed in the hope that it will be useful,

//    but WITHOUT ANY WARRANTY; without even the implied warranty of

//    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.

//    See the GNU General Public License for more details.

//

//    You should have received a copy of the GNU General Public License along

//    with emCORE.  If not, see <http://www.gnu.org/licenses/>.

//

//

#include "emcoreapp.h"

static void main()

{

    int x, y, r;

    int width = lcd_get_width();

    int height = lcd_get_height();

    int l1, s1, ls1, ss1, l2, s2, ls2, ss2, x1, y1, x2, y2, ox1, oy1, ox2, oy2;

    if (width > height)

    {

        l1 = width;

        s1 = height;

    }

    else

    {

        l1 = height;

        s1 = width;

    }

    for (l2 = 0x40000000; l2 > l1; l2 >>= 1);

    if ((l2 * 9) / 8 > l1) l2 >>= 1;

    while ((l2 / 9) * 6 > s1) l2 >>= 1;

    l1 = (l2 * 9) / 8;

    s1 = l2 / 2;

    s2 = s1 / 2;

    if (height >= l1)

    {

        x1 = s1;

        x2 = s2;

        y1 = l1;

        y2 = l2;

        ls1 = 0;

        ls2 = 0;

        ss1 = 0;

        ss2 = 0;

        ox1 = (width - s1 - s2) / 2;

        ox2 = ox1 + s1;

        oy1 = (height - l1) / 2;

        oy2 = oy1;

    }

    else

    {

        x1 = l1;

        x2 = l2;

        y1 = s1;

        y2 = s2;

        ls1 = 3 - 3 * l1 * s1;

        ls2 = 3 - 3 * l2 * s2;

        ss1 = l1 * 3 - 3;

        ss2 = l2 * 3 - 3;

        ox1 = (width - l1) / 2;

        ox2 = ox1;

        oy1 = (height - s1 - s2) / 2;

        oy2 = oy1 + s1;

    }

    uint8_t* framebuf = (uint8_t*)malloc(s1 * l1 * 3);

    if (!framebuf) panicf(PANIC_KILLTHREAD, "Out of memory!");

    int s = s1 / 4;

    uint8_t* ptr = framebuf;

    for (r = 0; r < 8; r++)

        for (y = 0; y < s; y++)

        {

            for (x = 0; x < s; x++)

            {

                *ptr++ = 1 << r;

                *ptr++ = 0;

                *ptr++ = 0;

                ptr += ss1;

            }

            for (x = 0; x < s; x++)

            {

                *ptr++ = 0;

                *ptr++ = 1 << r;

                *ptr++ = 0;

                ptr += ss1;

            }

            for (x = 0; x < s; x++)

            {

                *ptr++ = 0;

                *ptr++ = 0;

                *ptr++ = 1 << r;

                ptr += ss1;

            }

            for (x = 0; x < s; x++)

            {

                *ptr++ = 1 << r;

                *ptr++ = 1 << r;

                *ptr++ = 1 << r;

                ptr += ss1;

            }

            ptr += ls1;

        }

    for (y = 0; y < s; y++)

    {

        for (x = 0; x < s; x++)

        {

            *ptr++ = 0xff;

            *ptr++ = 0;

            *ptr++ = 0;

            ptr += ss1;

        }

        for (x = 0; x < s; x++)

        {

            *ptr++ = 0;

            *ptr++ = 0xff;

            *ptr++ = 0;

            ptr += ss1;

        }

        for (x = 0; x < s; x++)

        {

            *ptr++ = 0;

            *ptr++ = 0;

            *ptr++ = 0xff;

            ptr += ss1;

        }

        for (x = 0; x < s; x++)

        {

            *ptr++ = 0xff;

            *ptr++ = 0xff;

            *ptr++ = 0xff;

            ptr += ss1;

        }

        ptr += ls1;

    }

    displaylcd(ox1, oy1, x1, y1, framebuf, 0, 0, x1);

    int sx = s2 / 8;

    int sy = MAX(1, l2 / 256);

    int i = 256 / (l2 / sy);

    s = 8;

    for (x = i; x > 1; x >>= 1) s--;

    ptr = framebuf;

    for (r = 0; r < 256; r += i)

        for (y = 0; y < sy; y++)

        {

            for (x = 0; x < sx; x++)

            {

                *ptr++ = ~(r | (r >> s));

                *ptr++ = ~(r | (r >> s));

                *ptr++ = ~(r | (r >> s));

                ptr += ss2;

            }

            for (x = 0; x < sx; x++)

            {

                *ptr++ = r | (r >> s);

                *ptr++ = r | (r >> s);

                *ptr++ = r | (r >> s);

                ptr += ss2;

            }

            for (x = 0; x < sx; x++)

            {

                *ptr++ = 0;

                *ptr++ = r | (r >> s);

                *ptr++ = r | (r >> s);

                ptr += ss2;

            }

            for (x = 0; x < sx; x++)

            {

                *ptr++ = r | (r >> s);

                *ptr++ = 0;

                *ptr++ = r | (r >> s);

                ptr += ss2;

            }

            for (x = 0; x < sx; x++)

            {

                *ptr++ = r | (r >> s);

                *ptr++ = r | (r >> s);

                *ptr++ = 0;

                ptr += ss2;

            }

            for (x = 0; x < sx; x++)

            {

                *ptr++ = r | (r >> s);

                *ptr++ = 0;

                *ptr++ = 0;

                ptr += ss2;

            }

            for (x = 0; x < sx; x++)

            {

                *ptr++ = 0;

                *ptr++ = r | (r >> s);

                *ptr++ = 0;

                ptr += ss2;

            }

            for (x = 0; x < sx; x++)

            {

                *ptr++ = 0;

                *ptr++ = 0;

                *ptr++ = r | (r >> s);

                ptr += ss2;

            }

            ptr += ls2;

        }

    displaylcd(ox2, oy2, x2, y2, framebuf, 0, 0, x2);

    free(framebuf);

}

EMCORE_APP_HEADER("LCD test pattern generator", main, 127)