// Python 用FANUCイーサネット接続用DLL
//--------------------------------------------------------------------
// FANUC FOCAS2ライブラリの中で必要なファイル
//		32bit Python用
//			Fwlib32.lib
//			Fwlib32.h
//		64bit Python用
//			Fwlib64.lib
//			Fwlib64.h
//--------------------------------------------------------------------
#include "pch.h"
#include "stdio.h"
#include "Fwlib64.h"

//共通データ
int mcr_val_mem = 0;    //マクロ変数読み込み時の値の記憶メモリ
int dec_val_mem = 0;	//マクロ変数読み込み時の少数点位置記憶メモリ

extern "C" {

	//------------------------------------------------------------
	// FANUCとのインターネット接続実施関数
	//	引数
	//		int ip1:	IPアドレスの１番目の数値
	//		int ip2:        IPアドレスの２番目の数値
	//		int ip3:	IPアドレスの３番目の数値
	//		int ip4:	IPアドレスの４番目の数値
	//		int portP:	ポート番号
	//		int timeoutP:	タイムアウト時間(msec)
	//
	//	リターン値   >=0: ライブラリハンドル値
	//                    <0: エラー発生
	//		     -16:ソケット通信エラー
	//		     -15:機種別DLLが存在しません
	//		      -8:ハンドルの取得に失敗しました
	//-------------------------------------------------------------
	__declspec(dllexport) int fcnc_allclibhndl3(int ip1, int ip2, int ip3, int ip4, int portP, int timeoutP)
	{
		short result = 100;
		int errorNo = 0;
		unsigned short FlibHndl = 0;	//FANUC接続ハンドル
		int FlibHndlResult = 0;		//return用接続ハンドル値
		unsigned short port;
		long timeout;

		port = (unsigned short)portP;
		timeout = (long)timeoutP;

		char c_ip1[100];	//ipアドレスの１番目の数字文字列配列
		char c_ip2[30];		//ipアドレスの２番目の数字文字列配列
		char c_ip3[30];		//ipアドレスの３番目の数字文字列配列
		char c_ip4[30];		//ipアドレスの４番目の数字文字列配列
		char c_dot[] = ".";	//"."文字列

		//int を文字列に変換する
		sprintf_s(c_ip1, 100, "%d", ip1);
		sprintf_s(c_ip2, 30, "%d", ip2);
		sprintf_s(c_ip3, 30, "%d", ip3);
		sprintf_s(c_ip4, 30, "%d", ip4);

		//文字列を連結してIPアドレス文字列にする
		strcat_s(c_ip1, 100, c_dot);
		strcat_s(c_ip1, 100, c_ip2);
		strcat_s(c_ip1, 100, c_dot);
		strcat_s(c_ip1, 100, c_ip3);
		strcat_s(c_ip1, 100, c_dot);
		strcat_s(c_ip1, 100, c_ip4);

		printf(c_ip1);

		result = cnc_allclibhndl3(c_ip1, port, timeout, &FlibHndl); //FANUC API関数実行
		
		if (result == 0)	//エラー無?
		{
			//エラー無の時はハンドル値を返す
			FlibHndlResult = (int)FlibHndl;
			FlibHndlResult = FlibHndlResult & 0x0000ffff;
			return FlibHndlResult;
		}
		else
		{
			//エラー発生時はエラー値(<0)を返す
			return (int)result;
		}
	}

	//--------------------------------------------------------------------
	// FANUCとのインサーネット切断関数
	//	引数
	//		int FlibHndlPara:	ライブラリハンドル値
	//
	//	リターン値   0: OK　!=0:エラーコード
	//---------------------------------------------------------------------
	__declspec(dllexport) int fcnc_freelibhndl(int FlibHndlPara)
	{
		short result = 100;
		unsigned short FlibHndl = 0;	//FANUC接続ハンドル

		FlibHndl = (unsigned short)FlibHndlPara;

		result = cnc_freelibhndl(FlibHndl); //FANUC API関数実行
				
		return (int)result;
	}

	//-------------------------------------------------------------------
	//		FANUCのマクロデータ読込トリガ実施
	//	引数
	//		int FlibHndlPara:	ライブラリハンドル値
　　　　//　(fcnc_allclibhndl3()で取得)
	//		int number:		読み出すマクロ変数番号
	//
	//	リターン値	0: Ok,
	//				2:ブロックデータ長誤り,
	//				3:データ番号誤り
	//				6:オプション無
	//---------------------------------------------------------------------
	__declspec(dllexport) int fcnc_rdmacro_trg(int FlibHndlPara, int number)
	{
		short result = 100;
		unsigned short FlibHndl = 0;	//FANUC接続ハンドル
		ODBM macro;
		short s_number;

		FlibHndl = (unsigned short)FlibHndlPara;
		s_number = (short)number;

		result = cnc_rdmacro(FlibHndl, s_number, 10, &macro);	//FANUC API関数実行

		mcr_val_mem = (int)macro.mcr_val;	//カスタムマクロ変数値
		dec_val_mem = (int)macro.dec_val;	//少数点以下桁数

		return (int)result;
	}

	//----------------------------------------------------------
	//fcnc_rdmacro_trg()実施後のカスタムマクロ変数値を読み出す関数
	//	リターン値　　カスタムマクロ変数値
	//----------------------------------------------------------
	__declspec(dllexport) int fcnc_rdmacro_mcr_val()
	{
		return(mcr_val_mem);
	}


	//----------------------------------------------------------
	//fcnc_rdmacro_trg()実施後の少数点以下の桁数を読み出す関数
	//	リターン値　　カスタムマクロ変数の小数点以下の桁数
	//----------------------------------------------------------
	__declspec(dllexport) int fcnc_rdmacro_dec_val()
	{
		return(dec_val_mem);
	}
}

from ctypes import cdll
import ctypes

#FANUC CNCイーサネット接続用DLLを読み出す(64bit用)
F_dll = cdll.LoadLibrary('./FanucComDll64.dll') 

#FANUC CNCとイーサネット接続する
F_dll.fcnc_allclibhndl3.argtypes=(ctypes.c_int,ctypes.c_int,ctypes.c_int,ctypes.c_int,ctypes.c_int,ctypes.c_int)
F_dll.fcnc_allclibhndl3.restype=ctypes.c_int
FlibHndl = F_dll.fcnc_allclibhndl3(192, 168, 0, 1, 8193, 20)
print('FlibHndl=', FlibHndl)

#カスタムマクロ変数(#503）を読み出す
F_dll.fcnc_rdmacro_trg.argtypes=(ctypes.c_int,ctypes.c_int)
F_dll.fcnc_rdmacro_trg.restype=ctypes.c_int
result = F_dll.fcnc_rdmacro_trg(FlibHndl, 503)
if result == 0:     #正常終了？
    F_dll.fcnc_rdmacro_mcr_val.restype=ctypes.c_int
    mcr_val = F_dll.fcnc_rdmacro_mcr_val()  #マクロデータ値読出し
    
    F_dll.fcnc_rdmacro_dec_val.restype=ctypes.c_int
    dec_val = F_dll.fcnc_rdmacro_dec_val()  #少数点以下の桁数読出し
    
    print('rdmacro result=', result)
    print('mcr_val=', mcr_val)  #マクロデータ値表示
    print('dec_val=', dec_val)  #少数点以下の桁数表示
else:
    print('rdmacro result=', result)

#イーサネット切断する
F_dll.fcnc_freelibhndl.argtypes=(ctypes.c_int,)
F_dll.fcnc_freelibhndl.restype=ctypes.c_int
result = F_dll.fcnc_freelibhndl(FlibHndl)
print('disconnect result=',result)