/* * ***************************************************************** * * * * * 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. * * * * * ***************************************************************** */ /* CSC90X 最大内接円検出 NAISETUC.C */ /*[作成者]H.Yagi */ /* 目的: 関数: 履歴: Ver 1.0 97/08/29 Ver 1.1 99/03/16 計算幾何学ライブラリをコールするように変更 Ver 1.2 99/04/06 修正 Ver 1.3 99/08/19 エラー表示が処理時間と重なってしまうのを修正 注記: */ /* * Include compiler runtime library */ #include #include /* * 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_meas.h" #include "f_exmeas.h" #include "f_bndry.h" #include "f_cmpgeo.h" /* * Include CSC90X common local */ #include "m_menu.h" /* * プロトタイプ宣言 */ void main( void ); void main_menu_disp( void ); void disp_help( void ); void meas_set( void ); void pdm_bin_level( int, int, PARADIGM * ); void pdm_wind_set( int, int, PARADIGM * ); void exec( void ); void draw_cross( int, int, int, int ); int d4i5_d( double ); 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] = { { " BIN SET ", " 2値設定 " }, { " EXEC ", " 実 行 " }, { " PROC3 ", " 処理3 " }, { " PROC4 ", " 処理4 " } }; #define INIT_CUR_POS_X 255 #define INIT_CUR_POS_Y 239 #define MAX_PNT_NUM 3000 /* 入力点集合の点の最大数 */ #define BUFF_SIZE (512*480/4) static char *select_color[2] = { "黒", "白" }; static int pad_level_ms; static int wBinLevel; /* 2値レベル */ static int wxs,wys,wxe,wye; /* 計測範囲 */ static int wColor; /* 対象色 */ static int wMeasEdge; /* 接触塊オプション */ static int wLlimit; /* 面積下限値 */ static int wUlimit; /* 面積上限値 */ /* * メイン */ void main( void ) { int sts; int xpos; int ypos; int s_xpos; int s_ypos; /* 初期メッセージ表示 */ if( NORMAL_RETURN != message_note() ) return; /* パラメタ初期化 */ Lib_look_current_position( &xpos, &ypos ); s_xpos = xpos; s_ypos = ypos; wBinLevel = Lib_get_bin_level(); wxs = 0; wys = 0; wxe = 511; wye = 479; Lib_window( wxs, wys, wxe, wye ); wColor = 0; wMeasEdge = 1; wLlimit = 0; wUlimit = 245760; /* 入力ビデオ制御 */ 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 ); /* システム構築対応1次特徴量計測処理オープン */ Lib_Open_meas_structure ( ); /* メニュー制御 */ for (;;) { sts = 0; /* マウス位置読みとり */ Lib_look_current_position( &xpos, &ypos ); 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 ); meas_set(); /*2値計測設定*/ 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, "【機能\概要】 NAISETUC " ); Lib_chrdisp( 11, 10, "<最大内接円検出>" ); Lib_chrdisp( 11, 12, "○2値計測にて周囲座標抽出後、最大内接円を" ); Lib_chrdisp( 11, 14, " 検出します。" ); Lib_chrdisp( 11, 16, "○面積が最大の物体に対して処理します。" ); Lib_chrdisp( 11, 18, "○あまりいびつな形状では動作が不安定になる" ); Lib_chrdisp( 11, 20, " 場合があります。" ); } /************************************************************************/ /* 設定 */ /************************************************************************/ void meas_set( ) { PVAL value_ms[6]; int no; pad_level_ms = Lib_view_open(); Lib_view_set_title( pad_level_ms, "設定" ); Lib_view_set_uniq_numeral( pad_level_ms, 5, 5, "2値レベル", wBinLevel, 0, 255, 0 ); Lib_view_set_null ( pad_level_ms, 5, 35, "計測範囲" , 1 ); Lib_view_set_select ( pad_level_ms, 5, 65, "対象色", wColor, 2, select_color, 2 ); Lib_view_set_uniq_alter ( pad_level_ms, 5, 95, "境界", wMeasEdge, 3 ); Lib_view_set_uniq_numeral( pad_level_ms, 5, 125, "面積下限値", wLlimit, 0, 245760, 4 ); Lib_view_set_uniq_numeral( pad_level_ms, 5, 155, "面積上限値", wUlimit, 0, 245760, 5 ); Lib_set_paradigm( pad_level_ms, 0, WHOLE_TIMING, pdm_bin_level ); Lib_set_paradigm( pad_level_ms, 1, START_TIMING, pdm_wind_set ); Lib_view_set_size( pad_level_ms, 50, 50, 5, 5 ); Lib_draw_menu( pad_level_ms ); if ( ERROR_RETURN != ( no = Lib_process_menu( pad_level_ms, value_ms ) ) ) /* メニュー値の取得 */ { switch( no ) { case 101: /*「実行」が選択された */ wBinLevel = value_ms[0].value_type; wColor = value_ms[2].select_type; wMeasEdge = value_ms[3].on_off_type; wLlimit = value_ms[4].value_type; wUlimit = value_ms[5].value_type; break; case 102: /*「取り消し」が選択された */ break; } } Lib_erase_menu( pad_level_ms ); Lib_view_close( pad_level_ms ); } /*********************************************************************/ /*  2値レベル設定                         */ /*********************************************************************/ void pdm_bin_level( Timing, Numb, val ) int Timing; int Numb; PARADIGM val[]; { if ( START_TIMING == Timing ) { Lib_erase_menu( pad_level_ms ); Lib_input_video_control( BIN_PLANE ); Lib_display_control( BIN_PLANE | LINE_PLANE | CHAR_PLANE ); Lib_memory_clear( BIN_PLANE ); } else if ( END_TIMING == Timing ) { Lib_input_video_control( GRAY_PLANE ); Lib_display_control( GRAY_PLANE | LINE_PLANE | CHAR_PLANE ); Lib_memory_clear( LINE_PLANE | CHAR_PLANE ); Lib_draw_menu( pad_level_ms ); } Lib_video_bin_level( (int)val[0].long_type ); Lib_freerun(); } /*********************************************************************/ /*  ウインド設定制御                        */ /*********************************************************************/ void pdm_wind_set( Timing, Numb, val ) int Timing; int Numb; PARADIGM val[]; { int pad_level_wind; PVAL value_wind[2]; int no; int x_size,y_size; int idc; idc = Lib_shelter_plane( 0, 0, (Lib_get_dx_size() - 1), (Lib_get_dy_size() - 1), CHAR_PLANE ); pad_level_wind = Lib_view_open(); Lib_view_set_title( pad_level_wind, "処理範囲" ); x_size = wxe - wxs + 1; y_size = wye - wys + 1; Lib_view_set_box( pad_level_wind, 5, 5, "始点" , wxs , wys , 3, 1, 0 ); Lib_view_set_box( pad_level_wind, 5, 35, "サイズ", x_size, y_size, 3, 0, 1 ); Lib_view_set_size( pad_level_wind, 100, 130, 5, 5 ); Lib_draw_menu( pad_level_wind ); if( ERROR_RETURN != ( no = Lib_process_menu( pad_level_wind, value_wind ) ) ) { switch( no ) { case 101: /*「実行」が選択された */ wxs = value_wind[0].box_type.x; wys = value_wind[0].box_type.y; wxe = value_wind[0].box_type.x + value_wind[1].box_type.x - 1; wye = value_wind[0].box_type.y + value_wind[1].box_type.y - 1; break; case 102: /*「取り消し」が選択された */ break; } } Lib_erase_menu( pad_level_wind ); Lib_view_close( pad_level_wind ); Lib_recover_plane( idc ); } /************************************************************************/ /* 十字マーク表示 */ /************************************************************************/ void draw_cross( x, y, size, mode ) int x, y; /*入力:表示位置 */ int size; /*入力:長さ */ int mode; /*入力:0=GRAPH_ERAS, 1=GRAPH_DRAW */ { if ( GRAPH_DRAW == mode ) { Lib_drawline( x-size, y, x+size, y ); Lib_drawline( x, y-size, x, y+size ); } else { Lib_erasline( x-size, y, x+size, y ); Lib_erasline( x, y-size, x, y+size ); } } /***********************************************************************/ /* 入力数値(double)の4捨5入した数値(int)を返す */ /***********************************************************************/ int d4i5_d( in ) double in; /* 入力:浮動小数点数値 */ { int out; if ( in >= 0.0 ) out = (int)( in + 0.5 ); else out = (int)( in - 0.5 ); return( out ); } /*********************************************************************/ /* 実行                 */ /*********************************************************************/ void exec( void ) { static struct MEASDATA *measp; static int *indextbl; static struct CALCDATA *calcultp; unsigned int max_blob; char *error_string; int error_code; int dsw; int i; int ct; int blobno; int totalarea; static WPNT2_T point[MAX_PNT_NUM]; /* 入力座標群 */ void *vp; /* 識別子 */ WPNT2_T center; /* 求める最大空円の中心 */ int rds; /* 求める最大空円の半径 */ int maxarea; int maxarea_idx; static short buff[BUFF_SIZE]; short *sp; int num; int vect; double dr; char ss[70]; /* システムで設定されている「最大ブローブ数」の値を取得し、indextblに必要な容量の */ /* ワークメモリを確保する */ max_blob = Lib_get_meas_max_blob(); if ( ( int * )NULL != ( indextbl = ( int * )Lib_mlalloc( ( max_blob + 1 ) * 4 ) ) ) { Lib_input_video_control( BIN_PLANE ); Lib_display_control( BIN_PLANE | LINE_PLANE | CHAR_PLANE ); Lib_video_bin_level( wBinLevel ); if ( ON == ( dsw = Lib_get_display_switch() ) ) Lib_set_display_switch( OFF ); Lib_window( wxs, wys, wxe, wye ); /* 2値計測パラメータ設定 */ Lib_video_bin_level( wBinLevel ); Lib_strtclk_count(); /*タイマーカウントモードのスタート*/ Lib_freeze( TRANSMIT ); /* システム構築対応1次特徴量計測処理オープン */ Lib_Open_meas_structure(); if ( NORMAL_RETURN == Lib_xmeasure( wColor, wMeasEdge, 0, &measp ) ) /* メジャー */ { if ( 0 < ( ct = Lib_xorderng( measp, 0, 0, wColor, wUlimit, wLlimit, indextbl ) ) ) { if ( 1 == ct ) { blobno = indextbl[0]; Lib_calcult( 3, blobno, &calcultp); maxarea = calcultp->totalarea; /* 全面積 */ maxarea_idx = 0; } else if ( 1 < ct ) /* BLOBは複数ある? */ { maxarea = 0; maxarea_idx = 0; for (i=0; itotalarea; /* 全面積 */ if ( maxarea < totalarea ) { maxarea = totalarea; maxarea_idx = i; } } } blobno = indextbl[maxarea_idx]; vect = OFF; /*ベクトル化しない*/ if ( 0 < ( num = Lib_periphry( 0, measp, blobno, vect, ON, BUFF_SIZE, buff ) ) ) /*周囲座標抽出*/ { sp = buff; for ( i=0; i