rt-thread/components/gui/src/matrix.c

#include <rtgui/rtgui.h>
#include <rtgui/matrix.h>

/* Port from ejoy2d: https://github.com/cloudwu/ejoy2d/blob/master/LICENSE
 * Original License:
 *
 * The MIT License (MIT)
 *
 * Copyright (c) 2013 Ejoy.com Inc.
 *
 * Permission is hereby granted,  free of charge,  to any person obtaining a copy of
 * this software and associated documentation files (the "Software"),  to deal in
 * the Software without restriction,  including without limitation the rights to
 * use,  copy,  modify,  merge,  publish,  distribute,  sublicense,  and/or sell copies of
 * the Software,  and to permit persons to whom the Software is furnished to do so, 
 * subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in all
 * copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS",  WITHOUT WARRANTY OF ANY KIND,  EXPRESS OR
 * IMPLIED,  INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,  FITNESS
 * FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR
 * COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM,  DAMAGES OR OTHER LIABILITY,  WHETHER
 * IN AN ACTION OF CONTRACT,  TORT OR OTHERWISE,  ARISING FROM,  OUT OF OR IN
 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
 */

/* Port to RTGUI by Grissiom */

rt_inline int _inverse_scale(const int *m , int *o)
{
    if (m[0] == 0 || m[3] == 0)
        return 1;

    o[0] = _rtgui_matrix_round_div32(RTGUI_MATRIX_FRAC * RTGUI_MATRIX_FRAC, m[0]);
    o[1] = 0;
    o[2] = 0;
    o[3] = _rtgui_matrix_round_div32(RTGUI_MATRIX_FRAC * RTGUI_MATRIX_FRAC, m[3]);
    o[4] = _rtgui_matrix_round_div32(-m[4] * o[0], RTGUI_MATRIX_FRAC);
    o[5] = _rtgui_matrix_round_div32(-m[5] * o[3], RTGUI_MATRIX_FRAC);

    return 0;
}

rt_inline int _inverse_rot(const int *m, int *o)
{
    if (m[1] == 0 || m[2] == 0)
        return 1;

    o[0] = 0;
    o[1] = _rtgui_matrix_round_div32(RTGUI_MATRIX_FRAC * RTGUI_MATRIX_FRAC, m[2]);
    o[2] = _rtgui_matrix_round_div32(RTGUI_MATRIX_FRAC * RTGUI_MATRIX_FRAC, m[1]);
    o[3] = 0;
    o[4] = _rtgui_matrix_round_div32(-m[5] * o[2], RTGUI_MATRIX_FRAC);
    o[5] = _rtgui_matrix_round_div32(-m[4] * o[1], RTGUI_MATRIX_FRAC);

    return 0;
}

int rtgui_matrix_inverse(const struct rtgui_matrix *mm, struct rtgui_matrix *mo)
{
    const int *m = mm->m;
    int *o = mo->m;
    int t;

    if (m[1] == 0 && m[2] == 0)
    {
        return _inverse_scale(m,o);
    }
    if (m[0] == 0 && m[3] == 0)
    {
        return _inverse_rot(m,o);
    }

    t = m[0] * m[3] - m[1] * m[2];
    if (t == 0)
        return 1;

    o[0] = _rtgui_matrix_round_div6432((int64_t)m[3] * (RTGUI_MATRIX_FRAC * RTGUI_MATRIX_FRAC), t);
    o[1] = _rtgui_matrix_round_div6432(-(int64_t)m[1] * (RTGUI_MATRIX_FRAC * RTGUI_MATRIX_FRAC), t);
    o[2] = _rtgui_matrix_round_div6432(-(int64_t)m[2] * (RTGUI_MATRIX_FRAC * RTGUI_MATRIX_FRAC), t);
    o[3] = _rtgui_matrix_round_div6432((int64_t)m[0] * (RTGUI_MATRIX_FRAC * RTGUI_MATRIX_FRAC), t);
    o[4] = _rtgui_matrix_round_div6432(-((int64_t)m[4] * o[0] + (int64_t)m[5] * o[2]), RTGUI_MATRIX_FRAC);
    o[5] = _rtgui_matrix_round_div6432(-((int64_t)m[4] * o[1] + (int64_t)m[5] * o[3]), RTGUI_MATRIX_FRAC);

    return 0;
}

#define COS_TABLE_SZ  512
/* @dd is the degree range in 0~512 */
rt_inline int icost(int dd)
{
    static const short t[COS_TABLE_SZ] = {
        2048, 2048, 2047, 2047, 2046, 2044, 2042, 2040, 2038, 2036, 2033, 2029, 2026,
        2022, 2018, 2013, 2009, 2004, 1998, 1993, 1987, 1980, 1974, 1967, 1960, 1952,
        1945, 1937, 1928, 1920, 1911, 1902, 1892, 1882, 1872, 1862, 1851, 1840, 1829,
        1818, 1806, 1794, 1782, 1769, 1757, 1744, 1730, 1717, 1703, 1689, 1674, 1660,
        1645, 1630, 1615, 1599, 1583, 1567, 1551, 1534, 1517, 1500, 1483, 1466, 1448,
        1430, 1412, 1394, 1375, 1357, 1338, 1319, 1299, 1280, 1260, 1240, 1220, 1200,
        1179, 1159, 1138, 1117, 1096, 1074, 1053, 1031, 1009, 988, 965, 943, 921, 898,
        876, 853, 830, 807, 784, 760, 737, 714, 690, 666, 642, 619, 595, 570, 546, 522,
        498, 473, 449, 424, 400, 375, 350, 325, 301, 276, 251, 226, 201, 176, 151, 126,
        100, 75, 50, 25, 0, -25, -50, -75, -100, -126, -151, -176, -201, -226, -251,
        -276, -301, -325, -350, -375, -400, -424, -449, -473, -498, -522, -546, -570,
        -595, -619, -642, -666, -690, -714, -737, -760, -784, -807, -830, -853, -876,
        -898, -921, -943, -965, -988, -1009, -1031, -1053, -1074, -1096, -1117, -1138,
        -1159, -1179, -1200, -1220, -1240, -1260, -1280, -1299, -1319, -1338, -1357,
        -1375, -1394, -1412, -1430, -1448, -1466, -1483, -1500, -1517, -1534, -1551,
        -1567, -1583, -1599, -1615, -1630, -1645, -1660, -1674, -1689, -1703, -1717,
        -1730, -1744, -1757, -1769, -1782, -1794, -1806, -1818, -1829, -1840, -1851,
        -1862, -1872, -1882, -1892, -1902, -1911, -1920, -1928, -1937, -1945, -1952,
        -1960, -1967, -1974, -1980, -1987, -1993, -1998, -2004, -2009, -2013, -2018,
        -2022, -2026, -2029, -2033, -2036, -2038, -2040, -2042, -2044, -2046, -2047,
        -2047, -2048, -2048, -2048, -2047, -2047, -2046, -2044, -2042, -2040, -2038,
        -2036, -2033, -2029, -2026, -2022, -2018, -2013, -2009, -2004, -1998, -1993,
        -1987, -1980, -1974, -1967, -1960, -1952, -1945, -1937, -1928, -1920, -1911,
        -1902, -1892, -1882, -1872, -1862, -1851, -1840, -1829, -1818, -1806, -1794,
        -1782, -1769, -1757, -1744, -1730, -1717, -1703, -1689, -1674, -1660, -1645,
        -1630, -1615, -1599, -1583, -1567, -1551, -1534, -1517, -1500, -1483, -1466,
        -1448, -1430, -1412, -1394, -1375, -1357, -1338, -1319, -1299, -1280, -1260,
        -1240, -1220, -1200, -1179, -1159, -1138, -1117, -1096, -1074, -1053, -1031,
        -1009, -988, -965, -943, -921, -898, -876, -853, -830, -807, -784, -760, -737,
        -714, -690, -666, -642, -619, -595, -570, -546, -522, -498, -473, -449, -424,
        -400, -375, -350, -325, -301, -276, -251, -226, -201, -176, -151, -126, -100,
        -75, -50, -25, 0, 25, 50, 75, 100, 126, 151, 176, 201, 226, 251, 276, 301, 325,
        350, 375, 400, 424, 449, 473, 498, 522, 546, 570, 595, 619, 642, 666, 690, 714,
        737, 760, 784, 807, 830, 853, 876, 898, 921, 943, 965, 988, 1009, 1031, 1053,
        1074, 1096, 1117, 1138, 1159, 1179, 1200, 1220, 1240, 1260, 1280, 1299, 1319,
        1338, 1357, 1375, 1394, 1412, 1430, 1448, 1466, 1483, 1500, 1517, 1534, 1551,
        1567, 1583, 1599, 1615, 1630, 1645, 1660, 1674, 1689, 1703, 1717, 1730, 1744,
        1757, 1769, 1782, 1794, 1806, 1818, 1829, 1840, 1851, 1862, 1872, 1882, 1892,
        1902, 1911, 1920, 1928, 1937, 1945, 1952, 1960, 1967, 1974, 1980, 1987, 1993,
        1998, 2004, 2009, 2013, 2018, 2022, 2026, 2029, 2033, 2036, 2038, 2040, 2042,
        2044, 2046, 2047, 2047, 2048,
    };

    dd &= COS_TABLE_SZ - 1;

	return t[dd];
}

rt_inline int icosd(int d)
{
	int dd = d;
	return icost(dd);
}

rt_inline int isind(int d)
{
	int dd = COS_TABLE_SZ / 4 - d;
	return icost(dd);
}

rt_inline void rot_mat(int *m, int d)
{
	int cosd = icosd(d);
	int sind = isind(d);

	int m0_cosd = m[0] * cosd;
	int m0_sind = m[0] * sind;
	int m1_cosd = m[1] * cosd;
	int m1_sind = m[1] * sind;
	int m2_cosd = m[2] * cosd;
	int m2_sind = m[2] * sind;
	int m3_cosd = m[3] * cosd;
	int m3_sind = m[3] * sind;
	int m4_cosd = m[4] * cosd;
	int m4_sind = m[4] * sind;
	int m5_cosd = m[5] * cosd;
	int m5_sind = m[5] * sind;

	m[0] = _rtgui_matrix_round_div32(m0_cosd - m1_sind, RTGUI_MATRIX_FRAC);
	m[1] = _rtgui_matrix_round_div32(m0_sind + m1_cosd, RTGUI_MATRIX_FRAC);
	m[2] = _rtgui_matrix_round_div32(m2_cosd - m3_sind, RTGUI_MATRIX_FRAC);
	m[3] = _rtgui_matrix_round_div32(m2_sind + m3_cosd, RTGUI_MATRIX_FRAC);
	m[4] = _rtgui_matrix_round_div32(m4_cosd - m5_sind, RTGUI_MATRIX_FRAC);
	m[5] = _rtgui_matrix_round_div32(m4_sind + m5_cosd, RTGUI_MATRIX_FRAC);
}

rt_inline void scale_mat(int *m, int sx, int sy)
{
	if (sx != RTGUI_MATRIX_FRAC)
    {
		m[0] = _rtgui_matrix_round_div32(m[0] * sx, RTGUI_MATRIX_FRAC);
		m[2] = _rtgui_matrix_round_div32(m[2] * sx, RTGUI_MATRIX_FRAC);
		m[4] = _rtgui_matrix_round_div32(m[4] * sx, RTGUI_MATRIX_FRAC);
	}
	if (sy != RTGUI_MATRIX_FRAC)
    {
		m[1] = _rtgui_matrix_round_div32(m[1] * sy, RTGUI_MATRIX_FRAC);
		m[3] = _rtgui_matrix_round_div32(m[3] * sy, RTGUI_MATRIX_FRAC);
		m[5] = _rtgui_matrix_round_div32(m[5] * sy, RTGUI_MATRIX_FRAC);
	}
}

void rtgui_matrix_rotate(struct rtgui_matrix *m, int rot)
{
    if (rot)
        rot_mat(m->m, rot / (RTGUI_MATRIX_FRAC / COS_TABLE_SZ));
}
RTM_EXPORT(rtgui_matrix_rotate);

void rtgui_matrix_scale(struct rtgui_matrix *m, int sx, int sy)
{
	scale_mat(m->m, sx, sy);
}

void rtgui_matrix_move(struct rtgui_matrix *m, int dx, int dy)
{
	m->m[4] += dx;
	m->m[5] += dy;
}

void rtgui_matrix_dump(const struct rtgui_matrix *m)
{
	const int *mm = m->m;
    rt_kprintf("|%6d, %6d, %6d|\n", mm[0], mm[1], 0);
    rt_kprintf("|%6d, %6d, %6d|\n", mm[2], mm[3], 0);
    rt_kprintf("|%6d, %6d, %6d|\n", mm[4], mm[5], 1);
}