/* * ***************************************************************** * * * * * 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 2物体の重心距離計測(システム構築対応) LEN2BLOB.C */ /*[作成者]H.Yagi */ /* 目的: 関数: 履歴: Ver 1.0 98/10/06 Ver 2.0 00/04/25 注記:m_menu.hをインクルードして下さい。 m_menu.c及びm_note.cをリンクして下さい。 */ /* * 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_calip.h" /* * Include CSC90X common local */ #include "m_menu.h" /* * プロトタイプ宣言 */ void main( void ); void main_menu_disp( void ); void disp_help( void ); void set_para( void ); void pdm_bin_level( int, int, PARADIGM * ); void pdm_wind_set( int, int, PARADIGM * ); void exec( void ); void cross_mark2( 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 ", " 設 定 " }, { " EXEC ", " 実 行 " }, { " PROC3 ", " 処理3 " }, { " PROC4 ", " 処理4 " } }; #define INIT_CUR_POS_X 255 #define INIT_CUR_POS_Y 239 #define TARGET_NO 2 static char *select_color[2] = { "黒", "白" }; int pad_level; static char ss[70]; int wxs, wys, wxe, wye; int bin_level; int color; int edge; int l_limit; int u_limit; /* * メイン */ 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; bin_level = 128; wxs = 0; wys = 0; wxe = 511; wye = 479; color = 0; edge = 1; l_limit = 0; u_limit = 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; /* マウス位置読みとり */ 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 ); set_para(); 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, "【機能\概要】 LEN2BLOB" ); Lib_chrdisp( 11, 10, "2値計測を実行し、面積値が1番目と2番目に" ); Lib_chrdisp( 11, 12, "大きい2物体の重心間距離を求めるサンプルです。" ); Lib_chrdisp( 11, 14, "重心間距離はキャリパーライブラリで求めます。" ); } /************************************************************************/ /* 設定     */ /************************************************************************/ void set_para( void ) { PVAL value[6]; int no; pad_level = Lib_view_open(); Lib_view_set_title( pad_level, "設定" ); Lib_view_set_uniq_numeral( pad_level, 5, 5, "2値レベル" , bin_level, 0, 255, 0 ); Lib_view_set_null ( pad_level, 5, 35, "計測範囲" , 1 ); Lib_view_set_select ( pad_level, 5, 65, "対象色" , color, 2, select_color, 2 ); Lib_view_set_uniq_alter ( pad_level, 5, 95, "境界" , edge, 3 ); Lib_view_set_uniq_numeral( pad_level, 5, 125, "面積下限値", l_limit, 0, 245760, 4 ); Lib_view_set_uniq_numeral( pad_level, 5, 155, "面積上限値", u_limit, 0, 245760, 5 ); Lib_set_paradigm ( pad_level, 0, WHOLE_TIMING, pdm_bin_level ); Lib_set_paradigm ( pad_level, 1, START_TIMING, pdm_wind_set ); Lib_view_set_size( pad_level, 50, 80, 30, 5 ); Lib_draw_menu( pad_level ); if ( ERROR_RETURN != ( no = Lib_process_menu( pad_level, value ) ) ) /* メニュー値の取得 */ { switch( no ) { case 101: /*「実行」が選択された */ bin_level = value[0].value_type; color = value[2].select_type; edge = value[3].on_off_type; l_limit = value[4].value_type; u_limit = value[5].value_type; break; case 102: /*「取り消し」が選択された */ break; } } Lib_erase_menu( pad_level ); Lib_view_close( pad_level ); } /*********************************************************************/ /*  2値レベル設定                         */ /*********************************************************************/ void pdm_bin_level( Timing, Numb, val ) int Timing; int Numb; PARADIGM val[]; { if ( START_TIMING == Timing ) { Lib_erase_menu( pad_level ); 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 ); } 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 exec() { static struct MEASDATA *measp; static int *indextbl; static struct CALCDATA *calcultp; unsigned int max_blob; char *error_string; int error_code; int dsw; CPNT_T blob1,blob2; CPNT_T dummy; int i; int ct; int blobno; int totalarea; int tgarea[TARGET_NO]; double distance; int x[TARGET_NO], y[TARGET_NO]; Lib_input_video_control( BIN_PLANE ); Lib_display_control( BIN_PLANE | LINE_PLANE | CHAR_PLANE ); if ( ON == ( dsw = Lib_get_display_switch() ) ) Lib_set_display_switch( OFF ); /* システムで設定されている「最大ブローブ数」の値を取得し、indextblに必要な容量の */ /* ワークメモリを確保する */ max_blob = Lib_get_meas_max_blob(); if ( ( int * )NULL != ( indextbl = ( int * )Lib_mlalloc( ( max_blob + 1 ) * 4 ) ) ) { if ( NORMAL_RETURN == ( error_code = Lib_clp_open() ) ) { Lib_video_bin_level( bin_level ); Lib_strtclk_count(); /*タイマーカウントモードのスタート*/ Lib_freeze( TRANSMIT ); /* 処理範囲の設定 */ Lib_set_stage_window( wxs, wys, wxe, wye ); Lib_box( wxs, wys, wxe, wye, SOLID_LINE ); /* システム構築対応1次特徴量計測処理オープン */ Lib_Open_meas_structure(); if ( NORMAL_RETURN == Lib_xmeasure( color, edge, 0, &measp ) ) /* メジャー */ { if ( 0 < ( ct = Lib_xorderng( measp, 0, 0, color, u_limit, l_limit, indextbl ) ) ) { if ( TARGET_NO <= ct ) /* BLOBは2個以上? */ { for ( i=0; itotalarea; /* 全面積 */ if ( tgarea[0] < totalarea ) { tgarea[1] = tgarea[0]; blob2.x = blob1.x; /* 重心x */ blob2.y = blob1.y; /* 重心y */ tgarea[0] = totalarea; blob1.x = calcultp->centerx; /* 重心x */ blob1.y = calcultp->centery; /* 重心y */ } else if ( tgarea[1] < totalarea ) { tgarea[1] = totalarea; blob2.x = calcultp->centerx; /* 重心x */ blob2.y = calcultp->centery; /* 重心y */ } } blob1.wScale = 10; blob2.wScale = 10; Lib_clp_center_2Point( blob1, blob2, &dummy, &distance ); x[0] = blob1.x / blob1.wScale; y[0] = blob1.y / blob1.wScale; x[1] = blob2.x / blob2.wScale; y[1] = blob2.y / blob2.wScale; cross_mark2( x[0], y[0], 3 ); cross_mark2( x[1], y[1], 3 ); Lib_drawline( x[0], y[0], x[1], y[1] ); Lib_sprintf( ss, "距離 = %5.1f", distance ); Lib_chrdisp( 50, 30, ss ); Lib_time_disp( 0, 452 ); } else Lib_chrdisp( 1, 30, "エラー:ブローブが2個以上ありません。" ); } else Lib_chrdisp( 1, 30, "エラー:ブローブがありません。" ); } else { error_code = Lib_get_meas_error_code(); error_string = Lib_get_meas_error_string(); Lib_sprintf( ss, "2値計測エラー [%d] : %s", error_code, error_string ); Lib_chrdisp( 1, 30, ss ); } Lib_clp_close(); } else if ( ERROR_RETURN == error_code ) Lib_chrdisp( 1, 30, "エラー:Lib_clp_open 異常終了" ); else if ( CLP_MEMORY_ERR == error_code ) Lib_chrdisp( 1, 30, "エラー:Lib_clp_open メモリ確保に失敗しました。" ); } else Lib_chrdisp( 1, 30, "エラー:indextbl用のワークメモリを確保できません。" ); Lib_display_keyinput( 430, 0, " 確認 " ); Lib_cls( ( BIN_PLANE | LINE_PLANE | CHAR_PLANE ), BLACK_COLOR ); Lib_set_display_switch( dsw ); Lib_input_video_control( GRAY_PLANE ); Lib_display_control( GRAY_PLANE | LINE_PLANE | CHAR_PLANE ); Lib_freerun(); } /***** ×字マーク *****/ void cross_mark2( x, y, length ) int x; int y; int length; { Lib_drawline( x - length, y - length, x + length, y + length ); Lib_drawline( x + length, y - length, x - length, y + length ); }