ial.c

有了操作系统、TCP/IP协议栈、文件系统

/*
** $Id: ial.c,v 1.88 2005/01/08 08:10:38 weiym Exp $
** 
** The Input Abstract Layer of MiniGUI.
**
** Copyright (C) 2003~2005 Feynman Software.
** Copyright (C) 2000, 2002 Wei Yongming.
**
** Current maintainer: Wei Yongming.
**
** Create date: 2000/06/13
*/

/*
** This program 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.
**
** This program 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 this program; if not, write to the Free Software
** Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
*/

/* 
** TODO:
*/

#include <stdio.h>
#include <string.h>

#include "common.h"

#ifdef _SVGALIB
    #include <vga.h>
    #include <vgamouse.h>
    #include <vgakeyboard.h>
#endif
#ifdef _LIBGGI
    #include <ggi/ggi.h>
#endif

#include "minigui.h"
#include "misc.h"
#include "ial.h"

#ifdef _NATIVE_IAL_ENGINE
#include "native/native.h"
#endif

#ifdef _SVGALIB
    #include "svgalib.h"
#endif
#ifdef _LIBGGI
    #include "libggi.h"
#endif
#ifdef _EP7211_IAL
    #include "ep7211.h"
#endif
#ifdef _ADS_IAL
    #include "ads.h"
#endif
#ifdef _IPAQ_IAL
    #include "ipaq.h"
#endif
#ifdef _VR4181_IAL
    #include "vr4181.h"
#endif
#ifdef _HELIO_IAL
    #include "helio.h"
#endif
#ifdef _TFSTB_IAL
    #include "tf-stb.h"
#endif
#ifdef _T800_IAL
    #include "t800.h"
#endif
#ifdef _DUMMY_IAL
    #include "dummy.h"
#endif
#ifdef _AUTO_IAL
    #include "auto.h"
#endif
#ifdef _HH5249KBDIR_IAL
    #include "hh5249kbdir.h"
#endif
#ifdef _QVFB_IAL
    #include "qvfb.h"
#endif
#ifdef _MPC823_IAL
    #include "mpc823.h"
#endif
#ifdef _UCB1X00_IAL
    #include "ucb1x00.h"
#endif
#ifdef _PX255B_IAL
    #include "px255b.h"
#endif
#ifdef _MC68X328_IAL
    #include "mc68x328.h"
#endif
#ifdef _SMDK2410_IAL
    #include "2410.h"
#endif

#ifdef _EMBEST2410_IAL
    #include "embest2410.h"
#endif

#ifdef _DMGSTB_IAL
    #include "dmg-stb.h"
#endif
#ifdef _FIP_IAL
    #include "fip.h"
#endif
#ifdef _PALMII_IAL
    #include "palm2.h"
#endif
#ifdef _COMM_IAL
    #include "comminput.h"
#endif
#ifdef _HH2410R3_IAL
    #include "hh2410r3.h"
#endif
#ifdef _SVPXX_IAL
    #include "svpxx.h"
#endif
#ifdef _ADS7846_IAL
    #include "ads7846.h"
#endif
#ifdef _L7200_IAL
    #include "l7200.h"
#endif
#ifdef _WVFB_IAL
    #include "wvfb.h"
#endif
#ifdef _UTPMC_IAL
    #include "utpmc.h"
#endif
#ifdef _ARM3000_IAL
    #include "arm3000.h"
#endif
#ifdef _FFT7202_IAL
    #include "fft7202.h"
#endif
#ifdef _FFT9200_IAL
    #include "fft9200.h"
#endif
#ifdef _DM270_IAL
    #include "dm270.h"
#endif
#ifdef _EVMV10_IAL
    #include "evmv10.h"
#endif
#ifdef _FXRM9200_IAL
    #include "fxrm9200.h"
#endif
#ifdef _ABSSIG_IAL
    #include "abssig.h"
#endif

#define LEN_ENGINE_NAME        16
#define LEN_MTYPE_NAME         16

static INPUT inputs [] = 
{
#ifdef _DUMMY_IAL
    {"dummy", InitDummyInput, TermDummyInput},
#endif
#ifdef _AUTO_IAL
    {"auto", InitAutoInput, TermAutoInput},
#endif
#ifdef _HH5249KBDIR_IAL
    {"hh5249kbdir", InitHH5249KbdIrInput, TermHH5249KbdIrInput},
#endif
#ifdef _QVFB_IAL
    {"qvfb", InitQVFBInput, TermQVFBInput},
#endif
#ifdef _SVGALIB
    {"SVGALib", InitSVGALibInput, TermSVGALibInput},
#endif
#ifdef _LIBGGI
    {"LibGGI", InitLibGGIInput, TermLibGGIInput},
#endif
#ifdef _EP7211_IAL
    {"EP7211", InitEP7211Input, TermEP7211Input},
#endif
#ifdef _ADS_IAL
    {"ADS", InitADSInput, TermADSInput},
#endif
#ifdef _IPAQ_IAL
    {"ipaq", InitIPAQInput, TermIPAQInput},
#endif
#ifdef _VR4181_IAL
    {"VR4181", InitVR4181Input, TermVR4181Input},
#endif
#ifdef _HELIO_IAL
    {"Helio", InitHelioInput, TermHelioInput},
#endif
#ifdef _NATIVE_IAL_ENGINE
    {"console", InitNativeInput, TermNativeInput},
#endif
#ifdef _TFSTB_IAL
    {"TF-STB", InitTFSTBInput, TermTFSTBInput},
#endif
#ifdef _T800_IAL
    {"T800", InitT800Input, TermT800Input},
#endif
#ifdef _MPC823_IAL
    {"MPC823", InitMPC823Input, TermMPC823Input},
#endif
#ifdef _UCB1X00_IAL
    {"UCB1X00", InitUCB1X00Input, TermUCB1X00Input},
#endif
#ifdef _PX255B_IAL
    {"PX255B", InitPX255BInput, TermPX255BInput},
#endif
#ifdef _MC68X328_IAL
    {"MC68X328", InitMC68X328Input, TermMC68X328Input},
#endif
#ifdef _SMDK2410_IAL
    {"SMDK2410", Init2410Input, Term2410Input},
#endif
#ifdef _DMGSTB_IAL
    {"dmg-stb", InitDMGSTBInput, TermDMGSTBInput},
#endif
#ifdef _FIP_IAL
    {"fip", InitFIPInput, TermFIPInput},
#endif
#ifdef _PALMII_IAL
    {"palm2", InitPALMIIInput, TermPALMIIInput},
#endif
#ifdef _COMM_IAL
    {"comm", InitCOMMInput, TermCOMMInput},
#endif
#ifdef _HH2410R3_IAL
    {"hh2410r3", InitHH2410R3Input, TermHH2410R3Input},
#endif
#ifdef _SVPXX_IAL
    {"svpxx", InitSvpxxInput, TermSvpxxInput},
#endif
#ifdef _ADS7846_IAL
    {"ads7846", InitAds7846Input, TermAds7846Input},
#endif
#ifdef _L7200_IAL
    {"l7200", InitL7200Input, TermL7200Input},
#endif
#ifdef _ARM3000_IAL
    {"arm3000", InitARM3000Input, TermARM3000Input},
#endif
#ifdef _EMBEST2410_IAL
    {"embest2410", InitEMBEST2410Input, TermEMBEST2410Input},
#endif
#ifdef _FFT7202_IAL
    {"fft7202", InitFFTInput, TermFFTInput},
#endif
#ifdef _FFT9200_IAL
    {"fft9200", InitFFT9200Input, TermFFT9200Input},
#endif
#ifdef _WVFB_IAL
    {"wvfb", InitWVFBInput, TermWVFBInput}, 
#endif
#ifdef _UTPMC_IAL
    {"utpmc", InitUTPMCInput, TermUTPMCInput},
#endif
#ifdef _DM270_IAL
    {"dm270", InitDM270Input, TermDM270Input},
#endif
#ifdef _EVMV10_IAL
    {"evmv10", InitXscaleEVMV10Input, TermXscaleEVMV10Input},
#endif
#ifdef _FXRM9200_IAL
    {"fxrm9200", InitRm9200Input, TermRm9200Input},
#endif
#ifdef _ABSSIG_IAL
    {"abssig", InitABSSIGInput, TermABSSIGInput},
#endif
};

INPUT* __mg_cur_input;

#define NR_INPUTS  (sizeof (inputs) / sizeof (INPUT))

int InitIAL (void)
{
    int  i;

    char buff [LEN_ENGINE_NAME + 1];
    char mdev [MAX_PATH + 1];
    char mtype[LEN_MTYPE_NAME + 1];

    if (NR_INPUTS == 0)
	{
        	return ERR_NO_ENGINE;
	}
    if (GetMgEtcValue ("system", "ial_engine", buff, LEN_ENGINE_NAME) < 0)
        return ERR_CONFIG_FILE;

 /*   if (GetMgEtcValue ("system", "mdev", mdev, MAX_PATH) < 0)
        return ERR_CONFIG_FILE;

    if (GetMgEtcValue ("system", "mtype", mtype, LEN_MTYPE_NAME) < 0)
        return ERR_CONFIG_FILE;
*/

    for (i = 0; i < NR_INPUTS; i++) {
	printf("inputs[i].id=%s\n",inputs[i].id);
        if (strncmp (buff, inputs[i].id, LEN_ENGINE_NAME) == 0) {
	    printf("inputs[%d] \n",i);
            __mg_cur_input = inputs + i;
            break;
        }
    }
   
    if (__mg_cur_input == NULL) {
        fprintf (stderr, "IAL: Does not find matched engine.\n");
	printf("IAL:Does not find matched engine.\n");
        if (NR_INPUTS) {
            __mg_cur_input = inputs;
            fprintf (stderr, "IAL: Use the first engine: %s\n", __mg_cur_input->id);
		printf("IAL:Use the first engine. \n");
        }
        else
            return ERR_NO_MATCH;
    }

/*    strcpy (__mg_cur_input->mdev, mdev);*/

    if (!IAL_InitInput (__mg_cur_input, mdev, mtype)) {
        fprintf (stderr, "IAL: Init IAL engine failure.\n");
        return ERR_INPUT_ENGINE;
    }

#ifdef _DEBUG
    fprintf (stderr, "IAL: Use %s engine.\n", __mg_cur_input->id);
#endif

    return 0;
}

void TerminateIAL (void)
{
    IAL_TermInput ();
}

#ifdef _MISC_MOUSECALIBRATE

DO_MOUSE_CALIBRATE_PROC __mg_do_mouse_calibrate;

#define NR_EQUATIONS    6
#define LSHIFT(x)       ((x)<<10)
#define RSHIFT(x)       ((x)>>12)

static int vars1 [NR_EQUATIONS], vars2 [NR_EQUATIONS], vars3 [NR_EQUATIONS], vars4 [NR_EQUATIONS];

static void do_mouse_calibrate (int* x, int* y)
{
    int x1, y1, x2, y2, x3, y3, x4, y4;

    x1 = vars1 [0] * (*x) + vars1 [1] * (*y) + vars1 [2];
    y1 = vars1 [3] * (*x) + vars1 [4] * (*y) + vars1 [5];

    x2 = vars2 [0] * (*x) + vars2 [1] * (*y) + vars2 [2];
    y2 = vars2 [3] * (*x) + vars2 [4] * (*y) + vars2 [5];

    x3 = vars3 [0] * (*x) + vars3 [1] * (*y) + vars3 [2];
    y3 = vars3 [3] * (*x) + vars3 [4] * (*y) + vars3 [5];

    x4 = vars4 [0] * (*x) + vars4 [1] * (*y) + vars4 [2];
    y4 = vars4 [3] * (*x) + vars4 [4] * (*y) + vars4 [5];

    *x = RSHIFT (x1 + x2 + x3 + x4);
    *y = RSHIFT (y1 + y2 + y3 + y4);
}

#if 0
static double coef_const [NR_EQUATIONS][NR_EQUATIONS + 1];

static void forwardElimination (void)
{
     int i, j, k;

     for (i = 0; i < NR_EQUATIONS; i++)
          for (j = i; j< NR_EQUATIONS; j++)
               for (k = NR_EQUATIONS; k > i; k--)
                    coef_const [j][k] = coef_const [j][k] - coef_const [i][k] * coef_const [j][i]/coef_const [i][i];

}

static void backwardSubstitute (double* x)
{
     int j,k;
     double t;

     for (j = NR_EQUATIONS - 1; j > 0; j--) {
          t = 0.0;

          for (k = j; k < NR_EQUATIONS; k++)
               t = t + coef_const [j][k] * x[k];

          x[j] = (coef_const [j][NR_EQUATIONS] - t) / coef_const [j][j];
     }
}

static BOOL doGaussianElimination (double* x, const POINT* src_pts, const POINT* dst_pts)
{
    int i, j;

    for (i = 0; i < NR_EQUATIONS; i++) {
        for (j = 0; j <= NR_EQUATIONS; j++)
            coef_const [i][j] = 0.0;
    }

    coef_const [0][0] = src_pts [0].x;
    coef_const [0][1] = src_pts [0].y;
    coef_const [0][2] = 1.0;
    coef_const [0][6] = dst_pts [0].x;

    coef_const [1][3] = src_pts [0].x;
    coef_const [1][4] = src_pts [0].y;
    coef_const [1][5] = 1.0;
    coef_const [1][6] = dst_pts [0].y;

    coef_const [2][0] = src_pts [1].x;
    coef_const [2][1] = src_pts [1].y;
    coef_const [2][2] = 1.0;
    coef_const [2][6] = dst_pts [1].x;

    coef_const [3][3] = src_pts [1].x;
    coef_const [3][4] = src_pts [1].y;
    coef_const [3][5] = 1.0;
    coef_const [3][6] = dst_pts [1].y;

    coef_const [4][0] = src_pts [2].x;
    coef_const [4][1] = src_pts [2].y;
    coef_const [4][2] = 1.0;
    coef_const [4][6] = dst_pts [2].x;

    coef_const [5][3] = src_pts [2].x;
    coef_const [5][4] = src_pts [2].y;
    coef_const [5][5] = 1.0;
    coef_const [5][6] = dst_pts [2].y;

    forwardElimination ();
    backwardSubstitute (x);

    return TRUE;
}

#else

static BOOL doGaussianElimination (int* x, const POINT* src_pts, const POINT* dst_pts)
{
    int x12, x23, y12, y23, nx12, nx23, ny12, ny23;
    int numerator, denominator1, denominator2;

    x12 = (src_pts [0].x - src_pts [1].x);
    x23 = (src_pts [1].x - src_pts [2].x);
    y12 = (src_pts [0].y - src_pts [1].y);
    y23 = (src_pts [1].y - src_pts [2].y);

    nx12 = (dst_pts [0].x - dst_pts [1].x);
    nx23 = (dst_pts [1].x - dst_pts [2].x);
    ny12 = (dst_pts [0].y - dst_pts [1].y);
    ny23 = (dst_pts [1].y - dst_pts [2].y);

    denominator1 = x12*y23 - x23*y12;
    if (denominator1 == 0)
        return FALSE;

    denominator2 = y12*x23 - y23*x12;
    if (denominator2 == 0)
        return FALSE;

    numerator = nx12*y23 - nx23*y12;
    x [0] = LSHIFT (numerator) / denominator1;
    numerator = nx12*x23 - nx23*x12;
    x [1] = LSHIFT (numerator) / denominator2;
    x [2] = LSHIFT (dst_pts [0].x) - x [0] * src_pts [0].x - x [1] * src_pts [0].y;
    
    numerator = ny12*y23 - ny23*y12;
    x [3] = LSHIFT (numerator) / denominator1;
    numerator = ny12*x23 - ny23*x12;
    x [4] = LSHIFT (numerator) / denominator2;
    x [5] = LSHIFT (dst_pts [0].y) - x [3] * src_pts [0].x - x [4] * src_pts [0].y;

    return TRUE;
}

#endif

BOOL SetMouseCalibrationParameters (const POINT* src_pts, const POINT* dst_pts)
{
    POINT my_src_pts [3];
    POINT my_dst_pts [3];

    my_src_pts [0] = src_pts [0];
    my_src_pts [1] = src_pts [1];
    my_src_pts [2] = src_pts [4];
    my_dst_pts [0] = dst_pts [0];
    my_dst_pts [1] = dst_pts [1];
    my_dst_pts [2] = dst_pts [4];
    if (!doGaussianElimination (vars1, my_src_pts, my_dst_pts))
        return FALSE;

    my_src_pts [0] = src_pts [1];
    my_src_pts [1] = src_pts [2];
    my_src_pts [2] = src_pts [4];
    my_dst_pts [0] = dst_pts [1];
    my_dst_pts [1] = dst_pts [2];
    my_dst_pts [2] = dst_pts [4];
    if (!doGaussianElimination (vars2, my_src_pts, my_dst_pts))
        return FALSE;

    my_src_pts [0] = src_pts [2];
    my_src_pts [1] = src_pts [3];
    my_src_pts [2] = src_pts [4];
    my_dst_pts [0] = dst_pts [2];
    my_dst_pts [1] = dst_pts [3];
    my_dst_pts [2] = dst_pts [4];
    if (!doGaussianElimination (vars3, my_src_pts, my_dst_pts))
        return FALSE;

    my_src_pts [0] = src_pts [0];
    my_src_pts [1] = src_pts [3];
    my_src_pts [2] = src_pts [4];
    my_dst_pts [0] = dst_pts [0];
    my_dst_pts [1] = dst_pts [3];
    my_dst_pts [2] = dst_pts [4];
    if (!doGaussianElimination (vars4, my_src_pts, my_dst_pts))
        return FALSE;

    __mg_do_mouse_calibrate = do_mouse_calibrate;
    return TRUE;
}

#endif /* _MISC_MOUSECALIBRATE */