fork(1) download

copy

/*======================================*/
/* インクルード                         */
/*======================================*/
#include "sfr_r838a.h"                  /* R8C/38A SFRの定義ファイル    */
#include <stdlib.h>
#include <string.h>
#include <stdio.h>
#include <math.h>
#include  <errno.h>
#include "printf_lib.h"                 /* printf使用ライブラリ         */
//#include "hd44780.h" 
 
/*======================================*/
/* シンボル定義                         */
/*======================================*/
#define EDBZERO 50	//←←←オレ定義errno <divide by zero>
 
#define LCD_DB	p3
#define LCD_DB7	p3_3
#define LCD_DB6	p3_2
#define LCD_DB5	p3_1
#define LCD_DB4	p3_0
#define LCD_STB	p3_4
#define LCD_RS	p3_5
#define LCD_LGT	p3_6
#define PWRKEY	p3_7
 
#define KEY_INTERVAL 3 //キーパッド　サンプリング間隔[ms]
 
#define	AUTOLIGHTOFF	10000 //バックライトオフまでの時間(ms) 1000*10→10秒
#define	AUTOPOWEROFF	90000 //オートパワーオフまでの時間(ms) 1000*60*1.5→1.5分
 
 
#define SPACE	' '				//空白 
#define BLANK20	"                    "
 
//#define PI pi					//円周率
#define PI (atan(1.0) * 4.0)	//円周率
#define NAPIER (exp(1))	//ネイピア数
 
//#define ERRORMESSAGE	
 
/*	キー・ID定義	*/
#define KEYID_BKLGT			0x72
#define KEYID_71			0x71
#define KEYID_MODE			0x70
 
#define KEYID_RIGHT			0x34		//右	→
#define KEYID_LEFT			0x31		//左	←
#define KEYID_UP			0x33		//上	↑
#define KEYID_DOWN			0x32		//下	↓　
#define KEYID_SELECT		0x30		//中央(決定)
 
#define KEYID_NUM0			0x20
#define KEYID_NUMPOINT		0x01
#define KEYID_NUM1			0x22
#define KEYID_NUM2			0x03
#define KEYID_NUM3			0x02
#define KEYID_NUM4			0x24
#define KEYID_NUM5			0x05
#define KEYID_NUM6			0x04
#define KEYID_NUM7			0x26
#define KEYID_NUM8			0x07
#define KEYID_NUM9			0x06
#define KEYID_NUMDEL		0x17
#define KEYID_NUMAC			0x16
#define KEYID_NUMEQUAL		0x10
#define KEYID_NUMPLUS		0x13
#define KEYID_NUMMINUS		0x12
#define KEYID_NUMX			0x15
#define KEYID_NUMSLASH		0x14
#define KEYID_NUMNEG		0x11
#define KEYID_NUM10X		0x00
 
#define KEYID_INV			0x50	//正負
#define KEYID_NEG			0x47	//逆数
#define KEYID_SQUARE		0x51	//二乗
#define KEYID_SQROOT		0x52	//平方根
#define KEYID_POWER			0x53	//累乗（xのy乗）
 
#define KEYID_ANGLEUNIT		0x57	//角度の単位		度数法・弧度法　モード変更(ラーージーーーアーーーーーン！ディィィーーーーグリーーー！）
	#define	ANGLEUNIT_DEG	0		//度数法なら0
	#define	ANGLEUNIT_RAD	1		//弧度法なら1
#define KEYID_SIN			0x65	//サイン
#define KEYID_COS			0x66	//コサイン
#define	KEYID_TAN			0x67	//タンジェント
#define KEYID_ASIN			0x54	//アークサイン
#define KEYID_ACOS			0x55	//アークコサイン
#define	KEYID_ATAN			0x56	//アークタンジェント
 
 
#define	KEYID_PI			0x41	//円周率を挿入
#define	KEYID_NAPIER		0x42	//ネイピア数を挿入
#define KEYID_LOG10			0x40	//log10
#define	KEYID_LN			0x37	//loge(ネイピア数)
 
#define KEYID_DROP			0x27
#define KEYID_CHANGE		0x25
 
#define MODEID_PWROFF		00		//電源OFF
#define MODEID_IFX			01		//(InFiX mode).....中間記法
#define	MODEID_RPN			02		//(Reverse Polish Notation mode).....逆ポーランド記法
#define MODEID_LOGICAL		03		//論理演算モード(2進数、8進数、10進数、16進数)
#define	MODEID_CHMOD		0xff	//モードチェンジ用画面表示
#define	MODEID_DEFAULT		02		//初期状態
 
#define CHMOD_SCROLLY_0 	Lcd_line_print(2,MsgChmod2);Lcd_line_print(3,MsgChmod3);Lcd_line_print(4,MsgChmod4);
#define CHMOD_SCROLLY_1 	Lcd_line_print(2,MsgChmod3);Lcd_line_print(3,MsgChmod4);Lcd_line_print(4,MsgChmod5);
#define CHMOD_SCROLLY_2 	Lcd_line_print(2,MsgChmod4);Lcd_line_print(3,MsgChmod5);Lcd_line_print(4,MsgChmod6);
#define CHMOD_SCROLLY_3 	Lcd_line_print(2,MsgChmod5);Lcd_line_print(3,MsgChmod6);Lcd_line_print(4,MsgChmod7);
#define CHMOD_SCROLLY_4 	Lcd_line_print(2,MsgChmod6);Lcd_line_print(3,MsgChmod7);Lcd_line_print(4,MsgChmod8);
#define CHMOD_SCROLLY_MAX 4
#define CHMOD_SCROLLY_MIN 0
#define CHMOD_SCROLLY_PRINTLCD switch(scrollY){case 0: CHMOD_SCROLLY_0 break; case 1: CHMOD_SCROLLY_1 break; case 2: CHMOD_SCROLLY_2 break; case 3: CHMOD_SCROLLY_3 break; case 4: CHMOD_SCROLLY_4 break; default: scrollY=0; cursorY = 2; CHMOD_SCROLLY_0 break;}
 
#define X10_1	0x14	//___#_#__
#define X10_2	0x08	//____#___
#define X10_3	0x14	//___#_#__
#define X10_4	0x00	//________
#define X10_5	0x17	//___#_###
#define X10_6	0x15	//___#_#_#
#define X10_7	0x15	//___#_#_#
#define X10_8	0x17	//___#_###
 
#define MYCHARCODE1		0x08
#define MYCHARCODE2		0x09
#define MYCHARCODE3		0x0A
#define MYCHARCODE4		0x0B
#define MYCHARCODE5		0x0C
#define MYCHARCODE6		0x0D
#define MYCHARCODE7		0x0E
#define MYCHARCODE8		0x0F
 
#define MYCHAR1		\x08
#define MYCHAR2		\x09
#define MYCHAR3		\x0A
#define MYCHAR4		\x0B
#define MYCHAR5		\x0C
#define MYCHAR6		\x0D
#define MYCHAR7		\x0E
#define MYCHAR8		\x0F
 
/*======================================*/
/*　メンバ宣言　　　　　　　　　　　　　　　*/
/*======================================*/
struct stack{
		double var;
		struct stack far *next;
	};
 
 
/*======================================*/
/* プロトタイプ宣言                     */
/*======================================*/
void init( void );
void timer( unsigned long timer_set );
unsigned char dipsw_get( void );
 
unsigned char chmod(void);
void mode_rpn(void);
void mode_infix(void);
void mode_logical(void);
void mode_testing(void);
 
void Lcd_init(void);				//LCD初期化
void Lcd_output(char *str);			//
void Lcd_clear(void);
void Lcd_black(void);
void Lcd_cmd(char cmd);
void Lcd_data(char asci);
void Lcd_out(char code, char flag);
void Lcd_locate(char x, char y);										
 
 
 
 
 
			//カーソルの位置指定
void Lcd_cursol(char c_mode);														//カーソルの表示を変更
void Lcd_line_print(char y,char *str);												//LCDに出力。行数指定有り
void Lowspeed_Lcd_line_print(char y,unsigned long w,char *str);						//LCDに出力。行数指定有り。タイプライターっぽく遅延しながら表示
void Lcd_Itostring(char y, int digit, unsigned long data, char *buffer, char z);
void Lcd_write_cgram(char CharacterNo,const char *MyChar);
void Lcd_backlight(char z);
char Lcd_backlight_stat(void);
 
void Delay(long usec);
void Delay_ms(unsigned long msec);
 
//void Itostring(int digit, unsigned long data, char *buffer);
//void Ltostring(int digit, unsigned long long data, char *buffer);
void Ltostring_int(int digit, long long data, char *buffer);
void Ltostring_decimal(int digit, unsigned long long data, char *buffer);
 
void Keypad_read(void);
 
void Poweroff(void);
 
unsigned char Check_key_bit(unsigned char keyid,const char *buffer);
 
void stackin(char in,char digits,char position,char *stack);
 
 
void myftoa(char *string, double f, int format);
 
double myatof(const char *string);
 
unsigned long long POW(int a, int b);
 
void mode_infomation(void);
 
void AddStack(struct stack far *Stack1);
void DelStack(struct stack far *Stack1);
void FreeStack(struct stack far *Stack1);
int ExamineStackItemsNumber(struct stack far *Stack1);
 
double DegtoRad(double degree);
double RadtoDeg(double radian);
double mysin(double Angle , char AngleUnit);	//Angle:角度		AngleUnit:角度の単位(ANGLEUNIT_DEG,ANGLEUNIT_RAD)
double mycos(double Angle , char AngleUnit);	//Angle:角度		AngleUnit:角度の単位(ANGLEUNIT_DEG,ANGLEUNIT_RAD)
double mytan(double Angle , char AngleUnit);	//Angle:角度		AngleUnit:角度の単位(ANGLEUNIT_DEG,ANGLEUNIT_RAD)
double myasin(double Angle , char AngleUnit);	//Angle:角度		AngleUnit:角度の単位(ANGLEUNIT_DEG,ANGLEUNIT_RAD)
double myacos(double Angle , char AngleUnit);	//Angle:角度		AngleUnit:角度の単位(ANGLEUNIT_DEG,ANGLEUNIT_RAD)
double myatan(double Angle , char AngleUnit);	//Angle:角度		AngleUnit:角度の単位(ANGLEUNIT_DEG,ANGLEUNIT_RAD)
 
void error_handing(void);
/*======================================*/
/* グローバル変数の宣言                 */
/*======================================*/
unsigned long   cnt0;                   /* timer関数用                  */
unsigned char	cnt1;                   /* main内で使用                */
char cnt2;
char cnt3;
unsigned char pwrhold = 0;
char backlight_stat = 0;
char key0 = 0;
char keystat[8] = {0,0,0,0,0,0,0,0};
char keynow[8] = {0,0,0,0,0,0,0,0};
char keypast[8] = {0,0,0,0,0,0,0,0};
char keypast0[8] = {0,0,0,0,0,0,0,0};
char keypast1[8] = {0,0,0,0,0,0,0,0};
//char keypast2[8] = {0,0,0,0,0,0,0,0};
//char keypast3[8] = {0,0,0,0,0,0,0,0};
//char keypast4[8] = {0,0,0,0,0,0,0,0};
char keypast5[8] = {0,0,0,0,0,0,0,0};
char key0to1[8] = {0,0,0,0,0,0,0,0};
char key1to0[8] = {0,0,0,0,0,0,0,0};
const char blank20[21] = BLANK20;
unsigned long delayms = 0;
char Is_InfomationMode = 0;
char angleunitmode	= ANGLEUNIT_DEG;
char error_is = 0;
 
 
/************************************************************************/
/* メインプログラム                                                     */
/************************************************************************/
void main( void )
{
	unsigned char mode = MODEID_DEFAULT;
 
 
	/* マイコン機能の初期化 */
	init();                             /* 初期化                       */
    asm(" fset I ");                    /* 全体の割り込み許可           */
 
 
 
	while(1){				
		Lcd_init();
		Lcd_clear();
		Lcd_cursol(4);	
		Lcd_clear();
 
		adstby = 1;
		Delay(10000);
		adst=1;
		Delay(10000);					
		if(ad7 <= 100)	Poweroff();	//電池電圧チェックして2V以下なら電源落とす		
		adst=0;
		adstby = 0;
		switch(mode){
			case MODEID_PWROFF:		//電源OFF
				Poweroff();
				break;
 
			case MODEID_IFX:		//中間記法（普通の数式）モード
				mode_infix();		//中間記法(InFiX mode)
				mode = MODEID_CHMOD;
				break;
 
			case MODEID_RPN:		//RPN（逆ポーランド記法）モード
				mode_rpn();
				mode = MODEID_CHMOD;
				break;
			case MODEID_LOGICAL:	
				//mode_logical();
				mode_testing();
				mode = MODEID_CHMOD;
				break;
			case MODEID_CHMOD:
			default:								
				mode = chmod();		//モード変更画面
				break;
		}
	}
}//←←←←←←←メイン関数終了
 
unsigned char chmod(void){		//チェンジモード　モードIDを返します
	char cursorX,cursorY,scrollY,i; 
	char MsgChmod1[21] = " *** ChangeMODE 0-2 ";
	char MsgChmod2[21] = "0.PWR OFF           ";
	char MsgChmod3[21] = "1.InFiX MODE        ";
	char MsgChmod4[21] = "2.RPN MODE          ";
	char MsgChmod5[21] = "3.Logical operation ";
	char MsgChmod6[21] = "4.Undefined         ";
	char MsgChmod7[21] = "5.Undefined ...     ";
	char MsgChmod8[21] = "6.Undefined ...     ";
 
	Lcd_line_print(1,MsgChmod1);
 
	cursorX = 1;cursorY = 2;scrollY = 0;
 
	CHMOD_SCROLLY_PRINTLCD
	Lcd_locate(cursorX,cursorY);
	printf("/*** Change MODE ***/\n");
 
	while(1)
	{	
		Delay_ms(1);
		for(i=0;i<=7;i++)
		{
			key0to1[i] = keystat[i] & ~keypast5[i];
			keypast5[i] = keystat[i];
		}
		if(Check_key_bit(KEYID_RIGHT,key0to1))
		{
			cursorX++;
			Lcd_locate(cursorX,cursorY);
		}
		if(Check_key_bit(KEYID_LEFT,key0to1))
		{
			cursorX--;
			Lcd_locate(cursorX,cursorY);
		}
		if(Check_key_bit(KEYID_DOWN,key0to1))
		{
			cursorY++;
			Lcd_locate(cursorX,cursorY);
		}
		if(Check_key_bit(KEYID_UP,key0to1))
		{
			cursorY--;
			Lcd_locate(cursorX,cursorY);
		}
		if(Check_key_bit(KEYID_SELECT,key0to1)){
			switch(cursorY + scrollY){
				case 2:
				return MODEID_PWROFF;
				break;
				case 3:
				return MODEID_IFX;
				break;
				case 4:
				return MODEID_RPN;
				break;
				case 5:
				return MODEID_LOGICAL;
				return 3;
				break;
				case 6:
				return 4;
				break;
			}
		}
		if(Check_key_bit(KEYID_NUM0,key0to1)){
			return MODEID_PWROFF;
		}
		if(Check_key_bit(KEYID_NUM1,key0to1)){
			return MODEID_IFX;
		}
		if(Check_key_bit(KEYID_NUM2,key0to1)){
			return MODEID_RPN;
		}
		if(Check_key_bit(KEYID_NUM3,key0to1)){
			return MODEID_LOGICAL;
		}
		if(cursorY > 4)
		{
			scrollY++;
			cursorY = 4;			
			CHMOD_SCROLLY_PRINTLCD
			Lcd_locate(cursorX,cursorY);
		}
		if(cursorY < 2)
		{
			scrollY--;
			cursorY = 2;
			CHMOD_SCROLLY_PRINTLCD
			Lcd_locate(cursorX,cursorY);
		}
	if(cursorX > 20) {cursorX = 1;Lcd_locate(cursorX,cursorY);}
	if(cursorX < 1) {cursorX = 20;Lcd_locate(cursorX,cursorY);}
	}
	return MODEID_CHMOD;
}		//←←←←←←←chmod関数終了
 
void mode_infix(void){	//Infixモード（中間記法）
	printf("/*** Infix MODE ***/\n");
	return;	
}		//←←←←←←←mode_infix関数終了
 
void mode_rpn(void){	//RPNモード（逆ポーランド記法）
	unsigned char	i = 0; 
	char demical = 0;
	//char MsgPrint1[25] = "\0"; 
	//char MsgPrint2[25] = "\0"; 
	//char MsgPrint3[25] = "\0"; 
	//char MsgPrint4[25] = "\0";
 
	char KeyStack1[21];
	char KeyStack2[21];
	char KeyStack3[21] = "                    ";
	char KeyStack4[21] = " [  ][NOR][DEG][RPN]";//"          [DEG][RPN]";
	/*
	char KeyStack5[21];
	char KeyStack6[21];
	*/
 
	//double Stack[7] = {0,0,0,0,0,0,0};
	double temp;
 
	char Is_nextStackShift = 0;
	char cursor = 0;
	char cursormode = 4;
	char RefreshLCD = 1;
	char cursorpast = cursor;	
 
	const char xten[8] = { X10_1 , X10_2 , X10_3 , X10_4 , X10_5 , X10_6 , X10_7 , X10_8 };
 
	struct stack Stack1;	
 
	unsigned int number_of_stack = 1;//スタックの個数
	int formatmode = 1;
 
	Stack1.var = 0;
	Stack1.next = NULL;
 
	for(i=0;i<=20;i++)
	{
			KeyStack1[i] = SPACE;
			KeyStack2[i] = SPACE;
			KeyStack3[i] = SPACE;
			//KeyStack4[i] = SPACE;
			//KeyStack5[i] = SPACE;
			//KeyStack6[i] = SPACE;
	}
	KeyStack1[20] = '\0';
	KeyStack2[20] = '\0';
	KeyStack3[20] = '\0';
	KeyStack4[20] = '\0';
	//KeyStack5[20] = '\0';
	//KeyStack6[20] = '\0';	
 
 
	printf("/*** RPN MODE ***/\n");
 
	Lcd_write_cgram(MYCHARCODE1,xten);
 
	while(1)
	{	//printf("While Head\n");
		if(errno)	//エラー時の処理
		{
			error_handing();
			RefreshLCD = 0;
			while(error_is)
			{
				for(i=0;i<=7;i++)
				{
					while(keystat[i])
					{
						error_is = 0;
						RefreshLCD = 1;
					}
				}
			}
			Delay(500000);
			Delay(500000);
		}
		Delay_ms(1);
		for(i=0;i<=7;i++)
		{
			key0to1[i] = keystat[i] & ~keypast5[i];
			keypast5[i] = keystat[i];
		}
		if(RefreshLCD == 1)
		{
			number_of_stack = ExamineStackItemsNumber(&Stack1);
			for(i=0;i<=19;i++)
			{
				KeyStack2[i] = SPACE;
				KeyStack3[i] = SPACE;
			}
			if(number_of_stack >= 2) myftoa(KeyStack2,(Stack1.next -> var),formatmode);
			if(number_of_stack >= 3) myftoa(KeyStack3,(Stack1.next -> next -> var),formatmode);
			Ltostring_int(2,number_of_stack,&KeyStack4[2]);
			Lcd_cursol(1);
			Lcd_line_print(1,KeyStack4);
			Lcd_line_print(2,KeyStack3);
			Lcd_line_print(3,KeyStack2);
			Lcd_line_print(4,KeyStack1);
			RefreshLCD = 0;
			Lcd_locate(cursor+1,4);
			Lcd_cursol(cursormode);
			printf("KeyStack1 : %s\n",KeyStack1);
			printf("KeyStack2 : %s\n",KeyStack2);
			printf("KeyStack3 : %s\n",KeyStack3);
			printf("KeyStack4 : %s\n",KeyStack4);
		}
		if(cursorpast != cursor) 	Lcd_locate(cursor+1,4);
		cursorpast = cursor;
		{
				if(cursor > 19) cursor = 0;
 
				if(Check_key_bit(0x64,key0to1))	//デバッグ用キー
				{ 
					if(~Is_nextStackShift)
					{
						Stack1.var = myatof(KeyStack1);
					}
					if(Stack1.var != 0)
					{					//スタックに何か入ってたらEnter
						AddStack(&Stack1);
						cursor = 0;
						for(i=0;i<=19;i++)
						{
							KeyStack1[i] = SPACE;
						}
					}
					temp = sizeof(double);
					if(errno != 0)	continue;
					Stack1.var = temp;
					AddStack(&Stack1);
					cursor = 0;
					for(i=0;i<=19;i++)
					{
						KeyStack1[i] = SPACE;
					}
					temp = sizeof(struct stack far *);
					if(errno != 0)	continue;
					Stack1.var = temp;
					AddStack(&Stack1);
					cursor = 0;
					for(i=0;i<=19;i++)
					{
						KeyStack1[i] = SPACE;
					}
					temp = sizeof(struct stack);
					if(errno != 0)	continue;
					Stack1.var = temp;
					AddStack(&Stack1);
					cursor = 0;
					for(i=0;i<=19;i++)
					{
						KeyStack1[i] = SPACE;
					}
					myftoa(KeyStack1,Stack1.var,formatmode);
					RefreshLCD = 1;
					Is_nextStackShift = 1;
				}
				if(Check_key_bit(0x63,key0to1))	//デバッグ用キー
				{ 
					adstby = 1;
					Delay(10000);
					adst=1;
					Delay(10000);					
					if(~Is_nextStackShift)
					{
						Stack1.var = myatof(KeyStack1);
					}
					if(Stack1.var != 0)
					{					//スタックに何か入ってたらEnter
						AddStack(&Stack1);
						cursor = 0;
						for(i=0;i<=19;i++)
						{
							KeyStack1[i] = SPACE;
						}
					}
					i = ad7;
					//temp = (5/256)
					temp = (double) i;
					temp *= 0.01953125;
					if(errno != 0)	continue;
					Stack1.var = temp;
					myftoa(KeyStack1,Stack1.var,formatmode);
					RefreshLCD = 1;
					Is_nextStackShift = 1;
 
					adst=0;
					adstby = 0;
 
				}
				if(Check_key_bit(KEYID_MODE,key0to1))			//モードキーが押された時の処理
				{
					FreeStack(&Stack1);
					while(Check_key_bit(KEYID_MODE,keystat));	//モードキーが離されるまで待つ
					return;										//main()関数に戻る
				}
				if(Check_key_bit(0x74,key0to1))	//指数表記モード SCIentific notation
				{ 
					///678
					formatmode=0;
					KeyStack4[6] = 'S';
					KeyStack4[7] = 'c';
					KeyStack4[8] = 'i';
					if(~Is_nextStackShift)
					{
						Stack1.var = myatof(KeyStack1);
					}
					myftoa(KeyStack1,Stack1.var,formatmode);					
					RefreshLCD = 1;
				}
				if(Check_key_bit(0x73,key0to1))	//通常表示モード　NORmal notation
				{ 
					formatmode=1;
					KeyStack4[6] = 'N';
					KeyStack4[7] = 'o';
					KeyStack4[8] = 'r';
					if(~Is_nextStackShift)
					{
						Stack1.var = myatof(KeyStack1);
					}
					myftoa(KeyStack1,Stack1.var,formatmode);
					RefreshLCD = 1;
				}
 
				if(Check_key_bit(KEYID_LEFT,key0to1)) //方向キー　←
				{ 
					if(cursor) cursor--;
					while(Check_key_bit(KEYID_LEFT,keystat))
					{
						if(Check_key_bit(KEYID_NUM0,key0to1)) cursor =	0;
						if(Check_key_bit(KEYID_NUM1,key0to1)) cursor--;
						if(Check_key_bit(KEYID_NUM2,key0to1)) cursor -= 2;
						if(Check_key_bit(KEYID_NUM3,key0to1)) cursor -= 3;
						if(Check_key_bit(KEYID_NUM4,key0to1)) cursor -= 4;
						if(Check_key_bit(KEYID_NUM5,key0to1)) cursor -= 5;
						if(Check_key_bit(KEYID_NUM6,key0to1)) cursor -= 6;
						if(Check_key_bit(KEYID_NUM7,key0to1)) cursor -= 7;
						if(Check_key_bit(KEYID_NUM8,key0to1)) cursor -= 8;
						if(Check_key_bit(KEYID_NUM9,key0to1)) cursor -= 9;
						if(cursor > 19) cursor = 0;
						if(cursorpast != cursor)	Lcd_locate(cursor+1,4);
						cursorpast = cursor;
						for(i=0;i<=7;i++)
						{
							key0to1[i] = keystat[i] & ~keypast5[i];
							keypast5[i] = keystat[i];
						}
					}
				}
 
				if(Check_key_bit(KEYID_RIGHT,key0to1)) //方向キー　→
				{ 
					if(cursor<=19) cursor++;
					while(Check_key_bit(KEYID_RIGHT,keystat))
					{
						if(Check_key_bit(KEYID_NUM0,key0to1)) cursor =	19;
						if(Check_key_bit(KEYID_NUM1,key0to1)) cursor++;
						if(Check_key_bit(KEYID_NUM2,key0to1)) cursor += 2;
						if(Check_key_bit(KEYID_NUM3,key0to1)) cursor += 3;
						if(Check_key_bit(KEYID_NUM4,key0to1)) cursor += 4;
						if(Check_key_bit(KEYID_NUM5,key0to1)) cursor += 5;
						if(Check_key_bit(KEYID_NUM6,key0to1)) cursor += 6;
						if(Check_key_bit(KEYID_NUM7,key0to1)) cursor += 7;
						if(Check_key_bit(KEYID_NUM8,key0to1)) cursor += 8;
						if(Check_key_bit(KEYID_NUM9,key0to1)) cursor += 9;
						if(cursor > 19) cursor = 0;
						if(cursorpast != cursor)	Lcd_locate(cursor+1,4);
						cursorpast = cursor;
						for(i=0;i<=7;i++)
						{
							key0to1[i] = keystat[i] & ~keypast5[i];
							keypast5[i] = keystat[i];
						}
					}
				}
 
				if(Check_key_bit(KEYID_NUMAC,key0to1))	//AC押した時
				{ 
					printf("Check key AC\n");
					Is_nextStackShift = 0;					
					Lcd_clear();
					cursor = 0;
					for(i=0;i<=19;i++)
					{
						KeyStack1[i] = SPACE;
						KeyStack2[i] = SPACE;
						KeyStack3[i] = SPACE;
						//KeyStack4[i] = SPACE;
					}
					FreeStack(&Stack1);
					number_of_stack = 1;
					RefreshLCD = 1;
					error_is = 0;
				}
 
				if(Check_key_bit(KEYID_NUMDEL,key0to1))	//DEL押した時
				{ 
					printf("Check key DEL\n");  //cursorが"0"以外なら実行					
					cursor--;
					if(cursor <= 19) stackin(0x7f,19,cursor,KeyStack1); //0x7f…アスキーコードで「DEL」をあらわす
					Is_nextStackShift = 0;
					RefreshLCD = 1;
					i = 0;
					while(Check_key_bit(KEYID_NUMDEL,keystat))
					{
						i++;
						Delay_ms(10);
						if(Check_key_bit(KEYID_NUMAC,keystat))
						{
							for(i=0;i<=19;i++)
							{
								KeyStack1[i] = SPACE;
							}
							cursor = 0;
							//break;
						}
						if(i >= 80)
						{
							for(i=0;i<=19;i++)
							{
								KeyStack1[i] = SPACE;
							}
							cursor = 0;
							break;
						}
					}
					i = 0;
				}
 
				if(Check_key_bit(KEYID_NUMPOINT,key0to1))	//小数点キー押した時
				{ printf("Check key Dot\n");
					if(Is_nextStackShift)
					{
						Is_nextStackShift = 0;
						AddStack(&Stack1);
						cursor = 0;
						for(i=0;i<=19;i++)
						{
							KeyStack1[i] = SPACE;
						}
					}
					stackin('.',19,cursor,KeyStack1);
					++cursor;
					RefreshLCD = 1;
				}
 
				if(Check_key_bit(KEYID_NUM0,key0to1))	//数字キー 0
				{ 
					if(Is_nextStackShift)
					{
						Is_nextStackShift = 0;
						AddStack(&Stack1);
						cursor = 0;
						for(i=0;i<=19;i++)
						{
							KeyStack1[i] = SPACE;
						}
					}
					printf("Check key 0\n");
					stackin('0',19,cursor,KeyStack1);
					++cursor;
					RefreshLCD = 1;
				}
 
				if(Check_key_bit(KEYID_NUM1,key0to1))	//数字キー 1
				{ 
					if(Is_nextStackShift)
					{
						Is_nextStackShift = 0;
						AddStack(&Stack1);
						cursor = 0;
						for(i=0;i<=19;i++)
						{
							KeyStack1[i] = SPACE;
						}
					}
					printf("Check key 1\n");
					stackin('1',19,cursor,KeyStack1);
					++cursor;
					RefreshLCD = 1;
				}
 
				if(Check_key_bit(KEYID_NUM2,key0to1))	//数字キー 2
				{ 
					if(Is_nextStackShift)
					{
						Is_nextStackShift = 0;
						AddStack(&Stack1);
						cursor = 0;
						for(i=0;i<=19;i++)
						{
							KeyStack1[i] = SPACE;
						}
					}
					printf("Check key 2\n");
					stackin('2',19,cursor,KeyStack1);
					++cursor;
					RefreshLCD = 1;
				}
 
				if(Check_key_bit(KEYID_NUM3,key0to1))	//数字キー 3
				{ 
					if(Is_nextStackShift)
					{
						Is_nextStackShift = 0;
						AddStack(&Stack1);
						cursor = 0;
						for(i=0;i<=19;i++)
						{
							KeyStack1[i] = SPACE;
						}
					}
					printf("Check key 3\n");
					stackin('3',19,cursor,KeyStack1);
					++cursor;
					RefreshLCD = 1;
				}
 
				if(Check_key_bit(KEYID_NUM4,key0to1))	//数字キー 4
				{ 
					if(Is_nextStackShift)
					{
						Is_nextStackShift = 0;
						AddStack(&Stack1);
						cursor = 0;
						for(i=0;i<=19;i++)
						{
							KeyStack1[i] = SPACE;
						}
					}
					printf("Check key 4\n");
					stackin('4',19,cursor,KeyStack1);
					++cursor;
					RefreshLCD = 1;
				}
 
				if(Check_key_bit(KEYID_NUM5,key0to1))	//数字キー 5
				{ 
					if(Is_nextStackShift)
					{
						Is_nextStackShift = 0;
						AddStack(&Stack1);
						cursor = 0;
						for(i=0;i<=19;i++)
						{
							KeyStack1[i] = SPACE;
						}
					}
					printf("Check key 5\n");
					stackin('5',19,cursor,KeyStack1);
					++cursor;
					RefreshLCD = 1;
				}
 
				if(Check_key_bit(KEYID_NUM6,key0to1))	//数字キー 6
				{ 
					if(Is_nextStackShift)
					{
						Is_nextStackShift = 0;
						AddStack(&Stack1);
						cursor = 0;
						for(i=0;i<=19;i++)
						{
							KeyStack1[i] = SPACE;
						}
					}
					printf("Check key 6\n");
					stackin('6',19,cursor,KeyStack1);
					++cursor;
					RefreshLCD = 1;
				}
 
				if(Check_key_bit(KEYID_NUM7,key0to1))	//数字キー 7
				{ 
					if(Is_nextStackShift)
					{
						Is_nextStackShift = 0;
						AddStack(&Stack1);
						cursor = 0;
						for(i=0;i<=19;i++)
						{
							KeyStack1[i] = SPACE;
						}
					}
					printf("Check key 7\n");
					stackin('7',19,cursor,KeyStack1);
					++cursor;
					RefreshLCD = 1;
				}
 
				if(Check_key_bit(KEYID_NUM8,key0to1))	//数字キー 8
				{ 
					if(Is_nextStackShift)
					{
						Is_nextStackShift = 0;
						AddStack(&Stack1);
						cursor = 0;
						for(i=0;i<=19;i++)
						{
							KeyStack1[i] = SPACE;
						}
					}
					printf("Check key 8\n");
					stackin('8',19,cursor,KeyStack1);
					++cursor;
					RefreshLCD = 1;
				}
 
				if(Check_key_bit(KEYID_NUM9,key0to1))	//数字キー 9
				{ 
					if(Is_nextStackShift)
					{
						Is_nextStackShift = 0;
						AddStack(&Stack1);
						cursor = 0;
						//Lcd_clear();
						for(i=0;i<=19;i++)
						{
							KeyStack1[i] = SPACE;
						}
					}
					printf("Check key 9\n");
					stackin('9',19,cursor,KeyStack1);
					++cursor;
					RefreshLCD = 1;
				}
				if(Check_key_bit(KEYID_NUMEQUAL,key0to1))	//イコール＝　キー
				{ 
					if(Is_nextStackShift)
					{
 
					}else{
						Stack1.var = myatof(KeyStack1);
					}
					AddStack(&Stack1);
					printf("Check key Equal\n");
					cursor = 0;
					for(i=0;i<=19;i++)
					{
						KeyStack1[i] = SPACE;
					}
					Is_nextStackShift = 0;
					RefreshLCD = 1;
				}
				if(Check_key_bit(KEYID_INV,key0to1))	//　逆数
				{ 
					if(~Is_nextStackShift)
					{
						Stack1.var = myatof(KeyStack1);
					}
					if(Stack1.var == 0) errno = EDBZERO;
					temp = 1 / Stack1.var;
					if(errno != 0)	continue;
					Stack1.var = temp;
					myftoa(KeyStack1,Stack1.var,formatmode);
					RefreshLCD = 1;
					Is_nextStackShift = 1;
				}
				if(Check_key_bit(KEYID_NEG,key0to1))	//　正負変換
				{	
					if((KeyStack1[0] == SPACE)||(KeyStack1[cursor-1] == '\x08'))
					{
						RefreshLCD = 1;				
						//KeyStack1[0] = '-';
						stackin('-',19,cursor,KeyStack1);
						++cursor;
					}else
					{
						if(~Is_nextStackShift)
						{
							Stack1.var = myatof(KeyStack1);
						}
						temp = 0 - Stack1.var;
						if(errno != 0)	continue;
						Stack1.var = temp;
						myftoa(KeyStack1,Stack1.var,formatmode);
						RefreshLCD = 1;
						Is_nextStackShift = 1;
					}
				}
				if(Check_key_bit(KEYID_NUMNEG,key0to1))	//　正負変換
				{	
					if((KeyStack1[0] == SPACE)||(KeyStack1[cursor-1] == '\x08'))
					{
						RefreshLCD = 1;				
						//KeyStack1[0] = '-';
						stackin('-',19,cursor,KeyStack1);
						++cursor;
					}else
					{
						if(~Is_nextStackShift)
						{
							Stack1.var = myatof(KeyStack1);
						}
						temp = 0 - Stack1.var;
						if(errno != 0)	continue;
						Stack1.var = temp;
						myftoa(KeyStack1,Stack1.var,formatmode);
						RefreshLCD = 1;
						Is_nextStackShift = 1;
					}
				}
				if(Check_key_bit(KEYID_NUM10X,key0to1))	//　10^X
				{	
					if((KeyStack1[0]==SPACE)&&(KeyStack1[1]==SPACE)&&(KeyStack1[2]==SPACE))
					{
						stackin('1',19,0,KeyStack1);
						stackin('\x08',19,1,KeyStack1);
						RefreshLCD = 1;
						cursor = 2;
					}else
					{
						if(~Is_nextStackShift)
						{
							Stack1.var = myatof(KeyStack1);
						}
						//Stack1.var = 0 - Stack1.var;
						//myftoa(KeyStack1,Stack1.var,formatmode);
						stackin('\x08',19,cursor,KeyStack1);
						++cursor;
						RefreshLCD = 1;
					}
				}
				if(Check_key_bit(KEYID_SQUARE,key0to1))	//　二乗
				{ 
					if(~Is_nextStackShift)
					{
						Stack1.var = myatof(KeyStack1);
					}
					temp = Stack1.var * Stack1.var;
					if(errno != 0)	continue;
					Stack1.var = temp;
					myftoa(KeyStack1,Stack1.var,formatmode);
					RefreshLCD = 1;
					Is_nextStackShift = 1;
				}
				if(Check_key_bit(KEYID_SQROOT,key0to1))	//　平方根
				{ 
					if(~Is_nextStackShift)
					{
						Stack1.var = myatof(KeyStack1);
					}
					temp = sqrt(Stack1.var);
					if(errno != 0)	continue;
					Stack1.var = temp;
					myftoa(KeyStack1,Stack1.var,formatmode);
					RefreshLCD = 1;
					Is_nextStackShift = 1;
				}
				if(Check_key_bit(KEYID_LOG10,key0to1))	//常用対数　log10
				{ 
					if(~Is_nextStackShift)
					{
						Stack1.var = myatof(KeyStack1);
					}
					temp = log10(Stack1.var);
					if(errno != 0)	continue;
					Stack1.var = temp;
					myftoa(KeyStack1,Stack1.var,formatmode);
					RefreshLCD = 1;
					Is_nextStackShift = 1;
				}
				if(Check_key_bit(KEYID_LN,key0to1))	//自然対数　log e (ネイピア数
				{ 
					if(~Is_nextStackShift)
					{
						Stack1.var = myatof(KeyStack1);
					}
					temp = log(Stack1.var);
					if(errno != 0)	continue;
					Stack1.var = temp;
					myftoa(KeyStack1,Stack1.var,formatmode);
					RefreshLCD = 1;
					Is_nextStackShift = 1;
				}
				if(Check_key_bit(KEYID_SIN,key0to1))	//正弦サイン
				{ 
					if(~Is_nextStackShift)
					{
						Stack1.var = myatof(KeyStack1);
					}
					temp = mysin(Stack1.var,angleunitmode);
					if(errno != 0)	continue;
					Stack1.var = temp;
					myftoa(KeyStack1,Stack1.var,formatmode);
					RefreshLCD = 1;
					Is_nextStackShift = 1;
				}
				if(Check_key_bit(KEYID_ASIN,key0to1))	//アークサイン
				{ 
					if(~Is_nextStackShift)
					{
						Stack1.var = myatof(KeyStack1);
					}
					temp = myasin(Stack1.var,angleunitmode);
					if(errno != 0)	continue;
					Stack1.var = temp;
					myftoa(KeyStack1,Stack1.var,formatmode);
					RefreshLCD = 1;
					Is_nextStackShift = 1;
				}
				if(Check_key_bit(KEYID_COS,key0to1))	//コサイン
				{ 
					if(~Is_nextStackShift)
					{
						Stack1.var = myatof(KeyStack1);
					}
					temp = mycos(Stack1.var,angleunitmode);
					if(errno != 0)	continue;
					Stack1.var = temp;
					myftoa(KeyStack1,Stack1.var,formatmode);
					RefreshLCD = 1;
					Is_nextStackShift = 1;
				}
				if(Check_key_bit(KEYID_ACOS,key0to1))	//アークコサイン
				{ 
					if(~Is_nextStackShift)
					{
						Stack1.var = myatof(KeyStack1);
					}
					temp = myacos(Stack1.var,angleunitmode);
					if(errno != 0)	continue;
					Stack1.var = temp;
					myftoa(KeyStack1,Stack1.var,formatmode);
					RefreshLCD = 1;
					Is_nextStackShift = 1;
				}
				if(Check_key_bit(KEYID_TAN,key0to1))	//タンジェント
				{ 
					if(~Is_nextStackShift)
					{
						Stack1.var = myatof(KeyStack1);
					}
					temp = mytan(Stack1.var,angleunitmode);
					if(errno != 0)	continue;
					Stack1.var = temp;
					myftoa(KeyStack1,Stack1.var,formatmode);
					RefreshLCD = 1;
					Is_nextStackShift = 1;
				}
				if(Check_key_bit(KEYID_ATAN,key0to1))	//アークタンジェント
				{ 
					if(~Is_nextStackShift)
					{
						Stack1.var = myatof(KeyStack1);
					}
					temp = myatan(Stack1.var,angleunitmode);
					if(errno != 0)	continue;
					Stack1.var = temp;
					myftoa(KeyStack1,Stack1.var,formatmode);
					RefreshLCD = 1;
					Is_nextStackShift = 1;
				}
				if(Check_key_bit(KEYID_ANGLEUNIT,key0to1))	//角度の単位変更キー
				{ 
					angleunitmode = ~angleunitmode & 0x01;
					if(~Is_nextStackShift)
					{
						Stack1.var = myatof(KeyStack1);
					}
					if(angleunitmode == ANGLEUNIT_DEG)
					{
						temp = RadtoDeg(Stack1.var);
						KeyStack4[11] = 'D';
						KeyStack4[12] = 'E';
						KeyStack4[13] = 'G';
					}
					if(angleunitmode == ANGLEUNIT_RAD)
					{
						temp = DegtoRad(Stack1.var);
						KeyStack4[11] = 'R';
						KeyStack4[12] = 'A';
						KeyStack4[13] = 'D';
					}
					if(errno != 0)	continue;
					Stack1.var = temp;
					myftoa(KeyStack1,Stack1.var,formatmode);
					RefreshLCD = 1;
					Is_nextStackShift = 1;
				}
				if(Check_key_bit(KEYID_PI,key0to1))	//円周率キー
				{ 
					if(~Is_nextStackShift)
					{
						Stack1.var = myatof(KeyStack1);
					}
					if(Stack1.var != 0)
					{					//スタックに何か入ってたらEnter
						AddStack(&Stack1);
						cursor = 0;
						for(i=0;i<=19;i++)
						{
							KeyStack1[i] = SPACE;
						}
					}
					temp = PI;
					if(errno != 0)	continue;
					Stack1.var = temp;
					myftoa(KeyStack1,Stack1.var,formatmode);
					RefreshLCD = 1;
					Is_nextStackShift = 1;
				}
				if(Check_key_bit(KEYID_NAPIER,key0to1))	//ネイピア数キー
				{ 
					if(~Is_nextStackShift)
					{
						Stack1.var = myatof(KeyStack1);
					}
					if(Stack1.var != 0)
					{					//スタックに何か入ってたらEnter
						AddStack(&Stack1);
						cursor = 0;
						for(i=0;i<=19;i++)
						{
							KeyStack1[i] = SPACE;
						}
					}
					temp = NAPIER;
					if(errno != 0)	continue;
					Stack1.var = temp;
					myftoa(KeyStack1,Stack1.var,formatmode);
					RefreshLCD = 1;
					Is_nextStackShift = 1;
				}
 
				/* !!!! 以下、NULLポインタを参照する可能性のある処理 !!!! */
				/* NULLポインタ参照を防止するためIF文でブロックする */
				if(Stack1.next == NULL) continue;
 
				if(Check_key_bit(KEYID_DROP,key0to1))	//ドロップ　押した時
				{
					Stack1.var = (Stack1.next -> var);
					DelStack(&Stack1);
					myftoa(KeyStack1,Stack1.var,formatmode);
					Is_nextStackShift = 1;
					RefreshLCD = 1;
				}
				if(Check_key_bit(KEYID_CHANGE,key0to1))	//チェンジ　押した時				
				{
					if(~Is_nextStackShift)
					{
						Stack1.var = myatof(KeyStack1);
					}
					temp = Stack1.var;
					Stack1.var = Stack1.next -> var;
					Stack1.next -> var = temp;
					myftoa(KeyStack1,Stack1.var,formatmode);
					Is_nextStackShift = 1;
					RefreshLCD = 1;
				}
				if(Check_key_bit(KEYID_NUMPLUS,key0to1))	//プラス　+　押した時
				{ 
					printf("Check key PLUS +\n");
					if(~Is_nextStackShift)
					{
						Stack1.var = myatof(KeyStack1);
					}
					temp = Stack1.var + (Stack1.next -> var);
					if(errno != 0)	continue;
					Stack1.var = temp;
					DelStack(&Stack1);
					myftoa(KeyStack1,Stack1.var,formatmode);
					Is_nextStackShift = 1;
					RefreshLCD = 1;
				}
				if(Check_key_bit(KEYID_NUMMINUS,key0to1))	//マイナス -　押した時
				{ 
					printf("Check key MINUS\n");
					if(~Is_nextStackShift)
					{
						Stack1.var = myatof(KeyStack1);
					}
					temp = (Stack1.next -> var) - Stack1.var;
					if(errno != 0)	continue;
					Stack1.var = temp;
					myftoa(KeyStack1,Stack1.var,formatmode);
					DelStack(&Stack1);
					Is_nextStackShift = 1;
					RefreshLCD = 1;
				}
				if(Check_key_bit(KEYID_NUMX,key0to1))	//かける×　押した時
				{ 
					printf("Check key X(KAKEZAN)\n");
					if(~Is_nextStackShift)
					{
						Stack1.var = myatof(KeyStack1);
					}
					temp = Stack1.var * (Stack1.next -> var);
					if(errno != 0)	continue;
					Stack1.var = temp;
					myftoa(KeyStack1,Stack1.var,formatmode);
					DelStack(&Stack1);
					Is_nextStackShift = 1;
					RefreshLCD = 1;
				}
				if(Check_key_bit(KEYID_NUMSLASH,key0to1))	//割る÷　押した時
				{ 
					printf("Check key WARIZAN\n");
					if(~Is_nextStackShift)
					{
						Stack1.var = myatof(KeyStack1);
					}
					temp = (Stack1.next -> var) / Stack1.var;
					if(Stack1.var == 0) errno = EDBZERO;
					if(errno != 0)	continue;
					Stack1.var = temp;
					myftoa(KeyStack1,Stack1.var,formatmode);
					DelStack(&Stack1);
					Is_nextStackShift = 1;
					RefreshLCD = 1;
				}				
				if(Check_key_bit(KEYID_POWER,key0to1))	//累乗(xのy乗) Stack2^Stack1
				{
					if(~Is_nextStackShift)
					{
						Stack1.var = myatof(KeyStack1);
					}
					temp = pow((Stack1.next -> var),Stack1.var);
					if(errno != 0)	continue;
					Stack1.var = temp;
					myftoa(KeyStack1,Stack1.var,formatmode);
					RefreshLCD = 1;
				}
		}
	//printf("cursor: %d\n",cursor);
	}
}     //←←←←←←←mode_rpn関数終了
 
void mode_logical(void)
{
}     //←←←←←←←mode_logical関数終了
 
void mode_testing(void)	//テスト用モード。試してみたいコード・新機能を試すためのモード
{
	unsigned char	i = 0; 
 
}//←←←←←←←mode_testing関数終了
 
/************************************************************************/
/* R8C/38A スペシャルファンクションレジスタ(SFR)の初期化                */
/************************************************************************/
void init( void )
{
    int i;
 
    /* クロックをXINクロック(20MHz)に変更 */
    prc0  = 1;                          /* プロテクト解除               */
    cm13  = 1;                          /* P4_6,P4_7をXIN-XOUT端子にする*/
    cm05  = 0;                          /* XINクロック発振              */
    for(i=0; i<50; i++ );               /* 安定するまで少し待つ(約10ms) */
    ocd2  = 0;                          /* システムクロックをXINにする  */
    prc0  = 0;                          /* プロテクトON                 */
 
    /* ポートの入出力設定  0:入力　1:出力 76543210 */
    prc2 = 1;                           /* PD0のプロテクト解除          */
    pd0 = 0x00;                         /*         */
    pd1 = 0xd0;                         /* 5:RXD0 4:TXD0 3-0:DIP SW   1101 0000  */
    p2  = 0xc0;
    pd2 = 0xfe;                         /*   */
    pd3 = 0xff;                         /*LCD 0-DB4～3-DB7 4-Enable 5-RS 6-BkLGT*/
	p3	= 0x00;
    p4  = 0x00;                         /* P4_5のLED:初期は消灯         */
    pd4 = 0xb8;                         /* 7:XOUT 6:XIN 5:LED 2:VREF    */
    pd5 = 0x00;                         /*	キーマトリックス・入力	プルアップON	*/
	pu12 = 1;pu13 = 1;
    pd6 = 0xff;                         /*	キーマトリックス・出力			*/
	drr14 = 1; drr15 = 1;
    pd7 = 0x00;                         /* 	電池電圧検出用とか */
 
    pd8 = 0xff;                         /*                              */
    pd9 = 0x00;                         /*   0-5 IN                           */
	//p9 = 0x38;
    pur0 = 0x04;                        /* P1_3～P1_0のプルアップON     */
 
	vlt22 = 1;							/* P9_0～P9_5 入力スレッショルド→0.35×VCCにセット */
	vlt23 = 0;							/*  */
 
 
    /* タイマRBの設定 */
    /* 割り込み周期 = 1 / 20[MHz]   * (TRBPRE+1) * (TRBPR+1)
                    = 1 / (20*10^6) * 200        * 100
                    = 0.001[s] = 1[ms]
    */
    trbmr  = 0x00;                      /* 動作モード、分周比設定       */
    trbpre = 200-1;                     /* プリスケーラレジスタ         */
    trbpr  = 100-1;                     /* プライマリレジスタ           */
    trbic  = 0x06;                      /* 割り込み優先レベル設定       */
    trbcr  = 0x01;                      /* カウント開始                 */
 
 
    /* タイマRD リセット同期PWMモードの設定*/
    /* PWM周期 = 1 / 20[MHz]   * カウントソース * (TRDGRA0+1)
               = 1 / (20*10^6) * 8              * 40000
               = 0.016[s] = 16[ms]
    */
    trdpsr0 = 0x08;                     /* TRDIOB0,C0,D0端子設定        */
    trdpsr1 = 0x05;                     /* TRDIOA1,B1,C1,D1端子設定     */
    trdmr   = 0xf0;                     /* バッファレジスタ設定         */
    trdfcr  = 0x01;                     /* リセット同期PWMモードに設定  */
    trdcr0  = 0x23;                     /* ソースカウントの選択:f8      */
    trdgra0 = trdgrc0 ;      /* 周期                         */
    trdgrb0 = trdgrd0 = 0;              /* P2_2端子のON幅設定           */
    trdgra1 = trdgrc1 = 0;              /* P2_4端子のON幅設定           */
    trdgrb1 = trdgrd1 ;   /* P2_5端子のON幅設定           */
    trdoer1 = 0xcd;                     /* 出力端子の選択               */
    trdstr  = 0x0d;                     /* TRD0カウント開始             */
 
	//Delay_ms(2);
	p4  = 0x20;                         /* P4_5のLED:初期は点灯         */
 
	ch2 = 1; //AN19・p7_7
	ch1 = 1;
	ch0 = 1;
	adgsel0 = 0;
	adgsel1 = 1;
 
	md0 = 0; //単発モード
	md1 = 0; //単発モード
	md2 = 0; //単発モード
	adcap0 = 0; //ADSTﾋﾞｯﾄで開始
	adcap1 = 0;
	cks0 = 1; //f2を選択　cks1=0にする
 
	bits = 0; //8bit
	cks1 = 0;
 
	adstby = 0;
	//vcut = 1; //Vref接続
 
	//smp = 1; //ｻﾝﾌﾟﾙﾎｰﾙﾄﾞあり
 
 
	init_uart0_printf( SPEED_9600 );
	 printf(
        "\n/* START Function Calcrator Alpha Ver. */\n"
		"/* Made by kuriuzu */ \n"
        "/* This is UART Debug Console */\n"
    );
}
 
/************************************************************************/
/* タイマRB 割り込み処理                                                */
/************************************************************************/
#pragma interrupt intTRB(vect=24)
void intTRB( void )
{	
	delayms++;
    cnt0++;
    cnt1++;
	cnt2++;
	if(cnt2 == KEY_INTERVAL){
		cnt2 = 0;
		Keypad_read();
	}
}
 
/************************************************************************/
/* タイマ本体                                                           */
/* 引数  タイマ値 1=1ms                                                */
/************************************************************************/
void timer( unsigned long timer_set )
{
    delayms = 0;
    while( delayms < timer_set );
}
 
/************************************************************************/
/* ディップスイッチ値読み込み                                           */
/* 戻り値 スイッチ値 0～15                                              */
/************************************************************************/
unsigned char dipsw_get( void )
{
    unsigned char sw;
 
    sw = p1 & 0x0f;                     /* P1_3～P1_0読み込み           */
 
    return  sw;
}
 
 
 
//-----  ディレイ関数　msec単位 -----
 
void Delay_ms(unsigned long msec) //！注意！最大-1[ms]の誤差が出ます。！注意！
{
	delayms = 0;
	while(delayms < msec)
	{
		_asm(
				"fset	I;"
				"wait;"
				"nop;"
				"nop;"
				"nop;"
				"nop;"
				);
	}
}	
 
//-----  ディレイ関数  1usec単位 -----
 
void Delay(long usec)
{
	usec = (usec * 20000) / 45000;
	while(usec--){}
}
 
//----------------------------------------------------
//  液晶表示器制御ライブラリ
//----------------------------------------------------
 
//-----  LCD初期化関数  -----
 
void Lcd_init()
{
	Delay(20000);				//20msec wait
	Lcd_out(0x03, 1);			//8bit mode set
	Delay(5000);				//5msec wait
	Lcd_out(0x03, 1);			//8bit mode set
	Delay(1000);
	Lcd_out(0x03, 1);			//8bit mode set
	Delay(1000);
	Lcd_out(0x02, 1);			//4bit mode set
	Delay(1000);
	Lcd_cmd(0x2C);				//DL=0 4bit mode
	Lcd_cmd(0x08);				//display off C=D=B=0
	Lcd_cmd(0x0E);				//display on D=B=1 C=0
	Lcd_cmd(0x06);				//entry I/D=1 S=0
	Lcd_cmd(0x01);				//all clear
}
 
//-----  データ出力サブ関数  -----
 
void Lcd_out(char code, char flag)
{
	LCD_DB = (LCD_DB & 0xf0) | (code & 0x0f);
								//出力データ下位４ビットを出力
	if (flag == 0)				//表示データかコマンドか
		LCD_RS = 1;				//表示データの場合RS=1
	else
		LCD_RS = 0;				//コマンドデータの場合RS=0
	asm("NOP");					//NOP　スキュー確保		
	LCD_STB = 1;				//STB ON
	asm("NOP");
	asm("NOP");					//パルス幅確保230nsec以上
	asm("NOP");
	asm("NOP");
	LCD_STB = 0;					//STB OFF
}
 
//-----  １文字表示関数  -----
 
void Lcd_data(char asci)
{
	Lcd_out(asci>>4, 0);		//上位４ビット出力
	Lcd_out(asci, 0);			//下位４ビット出力
	Delay(50);					//50μsec待ち
}
 
//-----  コマンド出力関数  -----
 
void Lcd_cmd(char cmd)
{
	Lcd_out(cmd>>4, 1);			//上位４ビット出力
	Lcd_out(cmd, 1);			//下位４ビット出力
	if((cmd == 0x01) || (cmd == 0x02))
		Delay(2000);			//2msec待ち
	else
		Delay(50);				//50usec待ち
}
 
//-----  全消去関数  -----
 
void Lcd_clear()
{
	Lcd_cmd(0x01);				//初期化コマンド出力
}
 
//-----  文字列出力関数  -----
 
void Lcd_output(char *str)
{
	while(*str != 0x00)			//文字列の終わり判定
	{
		Lcd_data(*str);			//文字列１文字出力
		str++;					//ポインタ＋１
	}
}
 
//-----  カーソル位置に移動  -----
 
void Lcd_locate(char x, char y)
{
	char i;
	if (y == 1){
		Lcd_cmd(0x02);
		x--;
		while ( x ){
			Lcd_cmd(0x14);
			x--;
		}
	}else if (y == 2){
		Lcd_cmd(0x02);
		x--;
		for (i=1;i<=40;i++){
			Lcd_cmd(0x14);
		}
		while ( x ){
			Lcd_cmd(0x14);
			x--;
		}
	}else if (y == 3){
		Lcd_cmd(0x02);
		x--;
		for (i=1;i<=20;i++){
			Lcd_cmd(0x14);
		}
		while ( x ){
			Lcd_cmd(0x14);
			x--;
		}
	}else if (y == 4){
		Lcd_cmd(0x02);
		x--;
		for (i=1;i<=60;i++){
			Lcd_cmd(0x14);
		}
		while ( x ){
			Lcd_cmd(0x14);
			x--;
		}
	}
}
 
//-----  カーソル表示制御  -----
 
void Lcd_cursol(char c_mode)
{
	switch ( c_mode){
	case 1:				// 1.カーソルOFF、ブリンクOFF
		Lcd_cmd(0x0c);
		break;
	case 2:				// 2.カーソルOFF、ブリンクON
		Lcd_cmd(0x0d);
		break;
	case 3:				// 3.カーソルON、ブリンクOFF
		Lcd_cmd(0x0e);
		break;
	case 4:				// 4.カーソルON、ブリンクON
		Lcd_cmd(0x0f);
		break;
	}	
}
 
//-----  文字列出力関数(行指定あり)  -----
 
void Lcd_line_print(char y,char *str)
{
	if (y == 1){
		Lcd_cmd(0x80);
	} else if(y == 2){
		Lcd_cmd(0xC0);
	}else if(y == 3){
		Lcd_cmd(0x94);
	}else if(y == 4){
		Lcd_cmd(0xD4);
	}
	while(*str != 0x00){			//文字列の終わり判定
		Lcd_data(*str);			//文字列１文字出力
		str++;					//ポインタ＋１
	}
}
 
void Lowspeed_Lcd_line_print(char y,unsigned long w,char *str)
{
	if (y == 1){
		Lcd_cmd(0x80);
	} else if(y == 2){
		Lcd_cmd(0xC0);
	}else if(y == 3){
		Lcd_cmd(0x94);
	}else if(y == 4){
		Lcd_cmd(0xD4);
	}
	while(*str != 0x00){			//文字列の終わり判定
		Lcd_data(*str);			//文字列１文字出力
		Delay_ms(w);
		str++;					//ポインタ＋１
	}
}
 
void Lcd_black(void){
	char lp;
	Lcd_cmd(0x80);
	for(lp=0;lp<=0x67;lp++){		
		Lcd_data(0xff);		
	}
}
 
void Lcd_write_cgram(char CharacterNo,const char *MyChar)
{	
	int i;
	CharacterNo &= 0x07;
	CharacterNo = 0x40 | (CharacterNo<<3);
	Lcd_cmd(CharacterNo);
	for(i=0;i<=7;i++)
	{
		Lcd_data(*MyChar);
		MyChar++;
	}
 
}
void Lcd_backlight(char z)	//バックライト 0....OFF 1....ON
{
	backlight_stat = z;
	LCD_LGT = z;
}
char Lcd_backlight_stat(void)	//バックライト 0....OFF 1....ON
{
	return LCD_LGT;
}
/* //使われない関数
void Itostring(int digit, unsigned long data, char *buffer)
{
	char i;	
	buffer += digit;						//文字列の最後
	for(i=digit; i>0; i--)					//最下位桁から上位へ
	{	
		buffer--;							//ポインター１
		*buffer = (data % 10) + '0';		//その桁数値を文字にして格納
		data = data / 10;					//桁-1
	}
}
 
void Ltostring(int digit, unsigned long long data, char *buffer)
{
	char i;	
	buffer += digit;						//文字列の最後
	for(i=digit; i>0; i--)					//最下位桁から上位へ
	{	
		buffer--;							//ポインター１
		*buffer = (data % 10) + '0';		//その桁数値を文字にして格納
		data = data / 10;					//桁-1
	}
}
*/
 
void Ltostring_int(int digit, long long data, char *buffer)	
{
	char i;	
	if(data<0)
	{
		data *= -1;
		*buffer = '-';
		buffer++;
		digit--;
	}
	buffer += digit;						//文字列の最後
	for(i=digit; i>0; i--)					//最下位桁から上位へ
	{	
		buffer--;							//ポインター１
		*buffer = (data % 10) + '0';		//その桁数値を文字にして格納
		data = data / 10;					//桁-1
	}
}
void Ltostring_decimal(int digit, unsigned long long data, char *buffer)
{
	char i;	
	char not_space = 0;
	char number;
	buffer += digit;						//文字列の最後
	for(i=digit; i>0; i--)					//最下位桁から上位へ
	{	
		buffer--;							//ポインター１
		number = data % 10;
		if(number != 0)
		{
			not_space = 1;
		}
		if(not_space)
		{
			*buffer = number + '0';		//その桁数値を文字にして格納
		}else{
			*buffer = SPACE;
		}
		data = data / 10;					//桁-1
	}
	if(~not_space)
	{
		*buffer = number + '0';
	}
}
 
void Keypad_read(void)
{
	keypast[key0] = keystat[key0];
	keypast1[key0] = keypast0[key0];
	keypast0[key0] = keynow[key0];
	keynow[key0] = ~p5;
 
		/*	3msごとに実行したい処理とかを記述	*/	
		if(p5 != 0xff){
			cnt0 = 0;	
			Lcd_backlight(backlight_stat);
		}
 
	/*以下、通常のキーパッド読み込み業務*/
	if((keypast1[key0]==keypast0[key0])&(keypast0[key0]==keynow[key0])){keystat[key0] = keynow[key0];}
	switch(key0){
		case 0:
			key0++;
			p6 = ~0x02;
			break;
		case 1:
			key0++;
			p6 = ~0x04;
			break;
		case 2:
			key0++;
			p6 = ~0x08;
			break;
		case 3:
			key0++;
			p6 = ~0x10;
			break;
		case 4:
			key0++;
			p6 = ~0x20;
			break;
		case 5:
			key0++;
			p6 = ~0x40;
			break;
		case 6:
			key0++;
			p6 = ~0x80;
			break;
		default:
			key0 = 0;
			p6 = ~0x01;
				/*	以下、24[ms]ごとに実行したい処理を記述		*/
				if(p9_0){pwrhold++;}else{pwrhold = 0;}	//電源ボタンのポーリング
				if(pwrhold & ~Is_InfomationMode){
					mode_infomation();					//
				}
				if(Check_key_bit(KEYID_BKLGT,keystat) && (!Check_key_bit(KEYID_BKLGT,keypast)))	//バックライトボタンのポーリング
				{
					Lcd_backlight(~Lcd_backlight_stat());
				}	
				/*	
				if(Check_key_bit(KEYID_ANGLEUNIT,keystat) && (!Check_key_bit(KEYID_ANGLEUNIT,keypast)))	
				{
					angleunitmode = ~angleunitmode & 0x01;					
					if(angleunitmode == ANGLEUNIT_DEG)
					{
 
					{
					if(angleunitmode == ANGLEUNIT_RAD)
					{
 
					}
				}		*/
				if(cnt0 >= AUTOLIGHTOFF)		/*	バックライト・オフの時間が来たか確認	*/
				{					
					if(cnt0  > AUTOPOWEROFF)	/*	オートパワーオフの時間が来たら電源OFF	*/
					{
						Poweroff();
					}
					else
					{	/*	オートパワーオフの時間が来てなかったらバックライトOFF	*/
						if(Lcd_backlight_stat)	
						{
							Lcd_backlight(0);
							backlight_stat = 1;
						}
					}
				}
				/*　終わり　*/
			break;
		}
}
void Poweroff(void)
{
	char MsgPwrOFF1[21] = " *** PWR OFF ***    ";
	char MsgPwrOFF2[21] = "                    ";
	char MsgPwrOFF3[21] = "GOOD - BYE          ";
	char MsgPwrOFF4[21] = "     Made By Kuriuzu";		
		Lcd_line_print(1,MsgPwrOFF1);
		Lcd_line_print(2,MsgPwrOFF2);
		Lcd_line_print(3,MsgPwrOFF3);
		Lcd_line_print(4,MsgPwrOFF4);
	printf("/*** POWER OFF !!! ***/\n");
	Delay(500000);
	Delay(500000);
	Delay(500000);
	Delay(500000);
	Delay(500000);
	Delay(500000);
	Delay(500000);
	Delay(500000);
	Delay(500000);
	Delay(500000);
	Lcd_backlight(1);	/*電解コンデンサの電荷放電のためバックライトON*/
	asm(" fclr I ");                    /* 全体の割り込み禁止           */
	while(p9_0);
	Delay(250000);
	p4  = 0x00; 
	Lcd_backlight(0);	/*電解コンデンサの電荷放電のためバックライトON*/
	while(1);
}
 
unsigned char Check_key_bit(unsigned char keyid,const char *buffer)
{	
	if(keyid == 0xff)	return 0;	//0xff  
	buffer += (0x07 & (keyid>>4));
	return (*buffer >> (0x07 & keyid)) & 0x01;
}
 
void stackin(char in,char digits,char position,char *stack)     //in : 入力 digits：桁数 position；カーソル位置 stack (入力がD、dならcursor位置の文字削除)
{
        int i = 0;
        int j = 0;
        char point = 0;
        char buffer[35];
		buffer[digits + 1] = SPACE;
        if(position >= digits)
        {
                printf("ERROR : stackin() POSITION Over Digits\n");
				return;
        }else{
                for(i=0;i<=digits;i++)
                {
                        buffer[j] = *(stack + i);
                        j++;
                }
				if(in == 0x7f){	//DELキー押された時の処理
					    //↓カーソル位置(position)より後ろの配列を一個前にシフト
                        for(i = position;i <digits;i++)
                        {
                                buffer[i] = buffer[i+1];
                        }
						buffer[digits] = SPACE;
 
				}else if(buffer[position] == SPACE)
                {
                        buffer[position] = in;
                }else{
                        //↓カーソル位置(position)より後ろの配列を一個後ろにシフト
                        for(i = digits;i >=position;i--)
                        {
                                buffer[i] = buffer[i-1];
                        }
                        buffer[position] = in;
                }
                for(i=0;i<=digits;i++)
                {
                        *stack = buffer[i];
                        stack++;
                }
        }
}
 
void myftoa(char *string, double f, int format)		//string : 格納するポインタ　f：数値　format：指数表記(format <= 0)or通常表示(format > 0)
{		
		double requiddigit = 0; //その数を表すのに必要な桁数を格納
		int Integralpart = 1;//整数部桁数
		int Decimalpart = 17;//小数部桁数
		int Exponentpart = 2;
		int i;
		unsigned long long Decimal;//小数部のデータ
 
		if(f>0) 
		{
			//sign = 1;
			*string = ' ';
		}
		if(f==0){
			//sign = 0;
			*string = SPACE;
		}
		if(f<0) 
		{
			//sign = -1;
			f *= -1;
			*string = '-';
		}
		string++;
		if(format <= 0)
		{
			if(f)
			{
				if(f>1)	
				{
					/*
					requiddigit = log10(f+1);		
					f = f / POW(10,requiddigit);
					*/
					while(f>=10)
					{
						f /= 10;
						requiddigit++;
					}
				}else{
					/*
					requiddigit = (int)(log10(f) - 1);
					f = f * POW(10,requiddigit);
					*/
					while(f<1)
					{
						f *= 10;
						requiddigit--;
					}
				}
			}else{
				requiddigit = 1;
			}
			Integralpart = 1;
			Decimalpart = 13;
			if(abs(requiddigit)<10)	Exponentpart = 1;
			if(abs(requiddigit)>=100)	Exponentpart = 3;
			if(requiddigit<0)	Exponentpart++;
 
			Ltostring_int(Integralpart,(unsigned long long) f, string);
			string += Integralpart;
			*string = '.';
			string++;
			Decimal = (unsigned long long) (POW(10,Decimalpart)*(f - (unsigned long long)f) + 0.5);
			Ltostring_decimal(Decimalpart,Decimal,string);
			string += Decimalpart;
			for(i=(3-Exponentpart);i>0;i--)
			{
				*string = SPACE;
				string++;
			}
			*string = 0x08;
			string++;
			Ltostring_int(Exponentpart,(unsigned long long) requiddigit, string);
			//string += Exponentpart;
			return;
		}
		if(f)
		{
			requiddigit = log10(f);
		}else{
			requiddigit = 0;
		}
		if(requiddigit >= 0)
		{	
			requiddigit = log10(f+1);
			Integralpart = (int)requiddigit;
			++Integralpart;
			if(Integralpart > 19)	Integralpart = 19;
			Decimalpart = 18 - Integralpart;
		}else if(requiddigit < 0)
		{
		}
		Decimal = (unsigned long long) (POW(10,Decimalpart)*(f - (unsigned long long)f) + 0.5);
		Ltostring_int(Integralpart,(unsigned long long) f, string);
		if(Integralpart >= 19)	return;
		string += Integralpart;
		*string = '.';
		if(Integralpart >= 18)	return;
		string++;
		Ltostring_decimal(Decimalpart,Decimal,string);
 
}
 
double myatof(const char *string){
			int i;
            double rtn = 0;
            int decimal = 0;
            double temp = 0;
			double Exponent = 1; //指数表記の時に使用　m e x = m E x = m×10^x
            int Is_positive = 1; //正の数・・・1 負の数・・・-1
 
            while(*string != '\0')
            {
 
                    if((*string == '\x08')||(*string == 'e' )||( *string == 'E')){
                                                                            //指数表記の時の処理　（例：1.234×105 = 1.234e5）
                    	Exponent = myatof(string+1);
						if(Exponent < 0)
						{
							Exponent = fabs(Exponent);
							Exponent = POW(10,(int)Exponent);
							Exponent = 1 / Exponent;
						}else
						{
							Exponent = POW(10,(int)Exponent);
						}
						break;
                    }
                    else if(*string == '.' ){
                                                                            //小数点　ドットが来た時の処理
                        decimal++;
 
                    }else if(*string == '-' ){
                                                                            //負の数　マイナスが来た時の処理
                        Is_positive = -1;
 
 					}else if((*string >= '0')&(*string <= '9')){
                        if(decimal == 0)
                        {
                                rtn *= 10;
                            temp = *string - 0x30;
                            rtn += temp;
                        }
						else{
                                temp = *string - 0x30;
								for(i=0;i<decimal;i++){	temp /= 10;}
                                rtn += temp; 
                                decimal++;
 
                        }
                    }else{
 
					}
            string++;
            }
			rtn = rtn * Is_positive * Exponent;
       		return rtn;
}
 
void AddStack(struct stack far *Stack1)		//一個追加
{
	struct stack far *tempStackPtr;
	struct stack far *receiveStackPtr;
	tempStackPtr = Stack1 -> next;
	receiveStackPtr = (struct stack far *)calloc(1,sizeof(struct stack));
	if(receiveStackPtr == NULL)
	{	/*callocに失敗した時の処理*/
		errno = ENOMEM;
		return;
	}
	Stack1 -> next = receiveStackPtr;
	Stack1 -> next -> next = tempStackPtr;
	Stack1 -> next -> var = Stack1 -> var;
	Stack1 -> var = 0;
}
void DelStack(struct stack far *Stack1)		//一個削除
{
	struct stack far *tempStackPtr;
	tempStackPtr = Stack1 -> next -> next;
	free(Stack1 -> next);
	Stack1 -> next = tempStackPtr;
}
void FreeStack(struct stack far *Stack1)	//開放
{
	struct stack far *nextStackPtr;
	struct stack far *nowStackPtr;
	nowStackPtr = Stack1 -> next;
	nextStackPtr = nowStackPtr -> next;
	Stack1 -> var = 0;
	Stack1 -> next = NULL;
	if(nowStackPtr == NULL) return;
	if(nextStackPtr != NULL) FreeStack(nowStackPtr);	
	free(nowStackPtr);
}
int ExamineStackItemsNumber(struct stack far *Stack1)	//何個あるか調べる
{
	int rtn = 1;
	if(Stack1 -> next != NULL) rtn += ExamineStackItemsNumber(Stack1 -> next);
	return rtn;
}
 
unsigned long long POW(int a, int b)
{
	int i;
	long long ret = 1;
	b = abs(b);
	for( i=0; i<b; i++)ret *= a;
	return ret;
}
 
void mode_infomation(void)	/*動作状態表示とか(の予定)。PWRボタンで呼び出される*/
{
	unsigned int count = 0;
	Is_InfomationMode = 0;
	if(cnt0 <= 1000)	return;	
	Is_InfomationMode = 1;
	//Delay_ms(100);
	/*	*/
	while(p9_0)
	{	
		Delay(1000);
		count++;
		if(count >= 750)	Poweroff();
	}
 
	Is_InfomationMode = 0;
	return;
}
 
double DegtoRad(double degree)
{
	return degree * PI / 180.0;
}
double RadtoDeg(double radian)
{
	return radian * 180.0 / PI;
}
 
double mysin(double Angle , char AngleUnit)	//Angle:角度		AngleUnit:角度の単位(ANGLEUNIT_DEG,ANGLEUNIT_RAD)
{
	if(AngleUnit	== ANGLEUNIT_DEG)	Angle = DegtoRad(Angle);
	return	sin(Angle);
}
double mycos(double Angle , char AngleUnit)	//Angle:角度		AngleUnit:角度の単位(ANGLEUNIT_DEG,ANGLEUNIT_RAD)
{
	if(AngleUnit	== ANGLEUNIT_DEG)	Angle = DegtoRad(Angle);
	return	cos(Angle);	
}
double mytan(double Angle , char AngleUnit)	//Angle:角度		AngleUnit:角度の単位(0-Deg,1-Rad)
{
	if(AngleUnit	== ANGLEUNIT_DEG)	Angle = DegtoRad(Angle);
	return	tan(Angle);	
}
double myasin(double Angle , char AngleUnit)	//Angle:角度		AngleUnit:角度の単位(0-Deg,1-Rad)
{
	if(AngleUnit	== ANGLEUNIT_DEG)	return	RadtoDeg(asin(Angle));
	return	asin(Angle);
}
double myacos(double Angle , char AngleUnit)	//Angle:角度		AngleUnit:角度の単位(0-Deg,1-Rad)
{
	if(AngleUnit	== ANGLEUNIT_DEG)	return	RadtoDeg(acos(Angle));
	return	acos(Angle);	
}
double myatan(double Angle , char AngleUnit)	//Angle:角度		AngleUnit:角度の単位(0-Deg,1-Rad)
{
	if(AngleUnit	== ANGLEUNIT_DEG)	return	RadtoDeg(atan(Angle));
	return	atan(Angle);
}
void error_handing(void)
{	
	char MsgContentError[41];
	char MsgError1[21]			= " !!!!! ERROR !!!!!  ";
	char MsgError2[21]			= "        Error No.000";
	char MsgError4[21]			= "Please push ANY Key.";
	const char MsgEdom[21]		= "Math argument Error ";
	const char MsgErange[21]	= "Result too large Err";
	const char MsgEnomem[21]	= "Not enough MEMORY Er";
	const char MsgEdbzero[21]	= "Divide by ZERO ERROR";
	const char MsgEothr[21]		= "Unknown Error       ";
	Lcd_clear();
	switch(errno){
	case EDOM:
			strcpy(MsgContentError,MsgEdom);
			break;
	case ERANGE:
			strcpy(MsgContentError,MsgErange);
			break;
	case ENOMEM:
			strcpy(MsgContentError,MsgEnomem);
			break;
	case EDBZERO:
			strcpy(MsgContentError,MsgEdbzero);
			break;
	default:
			strcpy(MsgContentError,MsgEothr);
			break;
	}
	//strcpy(MsgContentError,strerror(errno));
	Ltostring_int(3,errno,&MsgError2[17]);
	Lcd_line_print(1,MsgError1);
	Lcd_line_print(2,MsgError2);
	Lcd_line_print(3,MsgContentError);
	Delay(500000);
	Delay(500000);
	Delay(500000);
	Delay(500000);
	Delay(500000);
	Delay(500000);
	Delay(500000);
	Delay(500000);
	Delay(500000);
	Lcd_line_print(4,MsgError4);
	Delay(500000);
	Delay(500000);
	Delay(500000);
	Delay(500000);
	Delay(500000);	
	errno = 0;
	error_is = 1;
}