/*
 * *****************************************************************
 * *                                                               *
 * *       Copyright (c) Fast Corporation, 1997                    *
 * *                                                               *
 * *   All Rights Reserved.  Unpublished rights  reserved  under   *
 * *   the copyright laws of the Japan.                            *
 * *                                                               *
 * *   The software contained on this media  is  proprietary  to   *
 * *   and  embodies  the  confidential  technology  of  Fast      *
 * *   Corporation.  Possession, use,  duplication  or             *
 * *   dissemination of the software and media is authorized only  *
 * *   pursuant to a valid written license from Fast Corporation.  *
 * *                                                               *
 * *****************************************************************
 */

/* ＣＳＣ９０Ｘ　最小自乗法楕円近似                         CALCELPS.C*/
/*［作成者］H.Yagi */
/*
目的：
関数：
履歴：  Ver 1.0     97/08/15
                    99/03/24  CSC903確認
注記：m_menu.hをインクルードして下さい。
      m_menu.c及びm_note.cをリンクして下さい。
*/

/*
 * Include compiler runtime library
 */
#include <string.h>
#include <math.h>


/*
 * Include CSC90X library
 */
#include "f_stdlib.h"
#include "f_time.h"
#include "f_gui.h"
#include "f_stdio.h"
#include "f_graph.h"
#include "f_image.h"
#include "f_pinf.h"
#include "f_video.h"
#include "f_system.h"
#include "f_math.h"


/*
 * Include CSC90X common local
 */
#include "m_menu.h"


/*
 * プロトタイプ宣言
 */
void  main( void );
void  main_menu_disp( void );
void  disp_help( void );
void dot_set( void );
void exec( void );
void cross_mark( int, int, int );

extern int  message_note( void );

/*
 * メニュー項目
 */
#define LANG_N       2
#define MAIN_MENU_N  4
static const char *str_main_menu[MAIN_MENU_N][LANG_N] = {
    { " SET DOTS ", "ドット設定" },
    { "   EXEC   ", " 楕円近似 " },
    { "  PROC3   ", "  処理３  " },
    { "  PROC4   ", "  処理４  " }
};


#define  INIT_CUR_POS_X     255
#define  INIT_CUR_POS_Y     239

#define MIN_DOT_NO  5
#define MAX_DOT_NO  32

POINT  point[32];
static char ss[70];
static int cnt;


/*
 * メイン
 */
void  main( void )
{
    int  sts;
    int  xpos;
    int  ypos;
    int  s_xpos;
    int  s_ypos;

    /* 初期メッセージ表示 */
    if( NORMAL_RETURN != message_note() )
        return;

    /* パラメタ初期化 */
    xpos = INIT_CUR_POS_X;
    ypos = INIT_CUR_POS_Y;
    s_xpos = INIT_CUR_POS_X;
    s_ypos = INIT_CUR_POS_Y;

    /* 入力ビデオ制御 */
    Lib_input_video_control( GRAY_PLANE );

    /* ビデオ出力表示項目制御 */
    Lib_display_control( GRAY_PLANE | LINE_PLANE | CHAR_PLANE );

    /* ビデオ表示項目クリア */
    Lib_memory_clear( LINE_PLANE | CHAR_PLANE );

    /* カーソル初期化 */
    Lib_init_cursor();

    /* メインメニューの表示 */
    main_menu_disp();

    /* マウスカーソルの表示 */
    Lib_draw_cursor( INIT_CUR_POS_X, INIT_CUR_POS_Y );

    /* メニュー制御 */
    for (;;)
    {
        sts = 0;

        /* マウス位置読みとり */
        sts = Lib_see_current_position( &xpos, &ypos );
        if ( s_xpos != xpos || s_ypos != ypos )
        {
            /* マウス表示位置移動 */
            Lib_move_cursor( xpos, ypos );
            s_xpos = xpos;
            s_ypos = ypos;
        }

        /* 処理振り分け */
        if( CURSOR_EXECUTE == sts )
        {
            if ( xpos > MENU_1_XS && xpos < MENU_1_XE && ypos > MENU_1_YS && ypos < MENU_1_YE )
            {
                Lib_memory_clear( LINE_PLANE | CHAR_PLANE );
                dot_set( );                                         /*ドット設定*/
                main_menu_disp();
            }
            else if ( xpos > MENU_2_XS && xpos < MENU_2_XE && ypos > MENU_2_YS && ypos < MENU_2_YE )
            {
                Lib_memory_clear( LINE_PLANE | CHAR_PLANE );
                exec( );                                            /*楕円近似試行*/
                main_menu_disp();
            }
            else if ( xpos > MENU_H_XS && xpos < MENU_H_XE && ypos > MENU_H_YS && ypos < MENU_H_YE )
            {
                Lib_memory_clear( LINE_PLANE | CHAR_PLANE );
                disp_help();                                        /* ヘルプ */
                main_menu_disp();
            }
            else if ( xpos > MENU_E_XS && xpos < MENU_E_XE && ypos > MENU_E_YS && ypos < MENU_E_YE )
            {
                break;                                              /* 終了 */
            }
        }
    }
}


/*
 * メインメニュー表示
 */
static void  main_menu_disp( void )
{
    int iLanguage;

    /* 日本語／英語表示文字列切替情報取得 */
    iLanguage = Lib_get_disp_language();

    /* 整列キー表示 -> ( m_menu.c ) */
    SUB_menu_disp4he( (char *)str_main_menu[0][iLanguage],
                    (char *)str_main_menu[1][iLanguage],
                    (char *)NULL,
                    (char *)NULL
                    );
}


/*
 * ヘルプ表示
 */
static void  disp_help( void )
{
    Lib_chrdisp( 10,  8, "【機能\概要】                  CALCELPS    " );
    Lib_chrdisp( 11, 10, "５〜３２個のドット設定の後、最小自乗法楕円近似" );
    Lib_chrdisp( 11, 12, "を行い求めた楕円を表\示します。" );
}


/************************************************************************/
/*  ドット設定                                                          */
/************************************************************************/
void dot_set( void )
{
int sts;
int xpos;
int ypos;
int s_xpos;
int s_ypos;

    xpos   = INIT_CUR_POS_X;
    ypos   = INIT_CUR_POS_Y;
    s_xpos = INIT_CUR_POS_X;
    s_ypos = INIT_CUR_POS_Y;

    cnt = 0;
    for (;;)
    {
        sts = 0;
        sts = Lib_see_current_position( &xpos, &ypos );  /* ﾏｳｽ位置読みとり */
        if ( s_xpos != xpos || s_ypos != ypos )
        {
          Lib_move_cursor( xpos, ypos );
          s_xpos = xpos;
          s_ypos = ypos;
        }
        if ( CURSOR_EXECUTE == sts )
        {
            point[cnt].x = xpos;
            point[cnt].y = ypos;
            Lib_pset( xpos, ypos, GRAPH_DRAW );
            cnt++;

            if ( MAX_DOT_NO <= cnt  )
                break;
        }
        if ( CURSOR_CANCEL == sts )
        {
            if ( cnt < MIN_DOT_NO )
                Lib_display_message( 70, 200, "CANCEL err!", "５点以上のドット設定が必要です。" );
            else
                break;
        }
    }
}


/************************************************************************/
/*  楕円近似試行                                                        */
/************************************************************************/
void exec( )
{
double xc, yc, rad_long, rad_short, angle, dangle;
int sin_val, cos_val;
int i;
int rtn;

	for ( i = 0; i < cnt; i++ )
		Lib_pset( point[i].x, point[i].y, 1 );
	
    if ( NORMAL_RETURN == ( rtn = Lib_fcalelps( cnt, point, &xc, &yc, &rad_long, &rad_short, &angle ) ) )
    {
		dangle = angle * 3.1415926 / 180.0;
		sin_val = (int)( sin( dangle ) * 1024.0 );
		cos_val = (int)( cos( dangle ) * 1024.0 );
		
		if ( NORMAL_RETURN == Lib_circle( (int)xc, (int)yc, (int)rad_long,
											(int)rad_short, sin_val, cos_val, GRAPH_DRAW ) )
		{
			cross_mark( (int)xc, (int)yc, 3 );
			
			Lib_sprintf( ss, "中心座標 ( %5.1f, %5.1f )", xc, yc );
			Lib_chrdisp( 1, 28, ss );
			Lib_sprintf( ss, "主軸半径 = %5.1f,  副軸半径 = %5.1f", rad_long, rad_short );
			Lib_chrdisp( 1, 29, ss );
			Lib_sprintf( ss, "主軸傾斜角 = %5.1f (度)", angle );
			Lib_chrdisp( 1, 30, ss );
		}
		else
			Lib_chrdisp( 1, 30, "Lib_circle ERR!" );
	}
	else
	{
        Lib_sprintf( ss, "Lib_fcalelps ERR! ( rtn = %d )", rtn );
        Lib_chrdisp( 1, 30, ss );
    }
    
    Lib_display_keyinput( 430, 0, "  確認  " );
	Lib_cls( ( LINE_PLANE | CHAR_PLANE ), BLACK_COLOR );
    
}

/***** 十字マーク *****/
void cross_mark( x, y, length )
int x;
int y;
int length;
{
	Lib_drawline( x - length, y, x + length, y );
	Lib_drawline( x, y - length, x, y + length );
}