/****************************?（C）?COPYRIGHT?2015?Fortiortech?shenzhen?*****************************
*?File?Name??????????:?AddFunction.c
*?Author?????????????:?Fortiortech??Appliction?Team
*?Version????????????:?V1.0
*?Date???????????????:?01/07/2015
*?Description????????:?This?file?contains?all?the?add?function?used?for?Motor?Control.
***************************************************************************************************
*?All?Rights?Reserved
**************************************************************************************************/


/*?Includes?-------------------------------------------------------------------------------------*/
#include?
#include?
extern?MCRAMP?????xdata?????mcSpeedRamp;
/*?Private?variables?---------------------------------------------------------*/
FaultStateType			mcFaultSource;
PWMINPUTCAL???xdata?mcPwmInput;
FOCCTRL???????xdata?mcFocCtrl;
FaultVarible??xdata?mcFaultDect;
ADCSample???????????AdcSampleValue;
VspInput						CommuteValue;
MCLedDisplay????????mcLedDisplay;
MCRAMP???????xdata??mcSpeedRamp;
uint16??????????????mcDcbusFlt;
int16???????????????segmentstate;
int16?							mcSpeedFlt;
MotorFRTypeDef			mcFRState;

int16?							OMEGA_READ;
int16?							VSP;
uint16??????????????StartCurrentRef;
uint8???????????????MotorSleepFlag;
uint16??????????????MotorSleepDelayCout;
uint8???????????????Sleep_En;
uint16??????????????SMO_EK2;
MotorTailWindTypeDef?xdata??TailWindDetect;
const?int16??PowerGiven[10]?={050010002200290043005900730079008550};
uint16?temp1=0;
uint16?temp2=0;
extern?FaultVarible??xdata?mcFaultDect;

uint16?MotorONOFF_Count1=0;
uint16?MotorONOFF_Count2=0;
uint16?MotorONOFF_Count3=0;

uint8?FG_Flag0=0;
uint8?FG_Flag1=1;
uint8?FG_Flag2=0;	
uint8?FG_Flag3=0;
uint8?FG_Enable=0;

uint8?Check_PWM=0;
uint8?Check_PWM_Min=0;
/*---------------------------------------------------------------------------*/
/*?Name		:	int16?KLPF_VALUE（int16?INVlaue?int16?OutLastValue）
/*?Input	:	INVlaue，OutLastValue
/*?Output	:	int16的變量
/*?Description:	濾波函數用乘法器做的
/*---------------------------------------------------------------------------*/
int16?KLPF_VALUE（int16?INVlaue?int16?OutLastValue）
{	
	int16?Result?=?0;
	MD_MA?=?（INVlaue-OutLastValue）;
	MD_MB?=?（int16）480;		???????????			/*寫被乘數和乘數*/

	Result?=?MD_MB;
	Result?+=?OutLastValue;
	return（Result）;
}

/*---------------------------------------------------------------------------*/
/*?Name		:	void?FaultProcess（void）
/*?Input	:	NO
/*?Output	:	NO
/*?Description:	保護處理函數，關閉FOC輸出，同時將狀態變為mcFault
/*---------------------------------------------------------------------------*/
void?FaultProcess（void）
{
			FOC_SET0?&=?0x7F;																				//?disable?FOC?and?clear?all?register
			FOC_CR1?=?0x00;																					//?disable?FOC?output?and?initial?register
			mcState?=?mcFault;
			MOE?????=?0;	
}
/*----------------------------------------------------------

?屬性????????????大小?????日期????時間???名稱
-----------?---------??----------?-----??----

?????文件???????1815??2015-07-27?13:51??FU6831\Document\DebugLog.txt

?????文件???????1350??2016-03-25?19:11??FU6831\Document\ReadMe.txt

?????文件?????147779??2018-07-27?12:40??FU6831\KeilC51\FOC_Fortior.uvgui.Administrator

?????文件?????144452??2019-04-10?12:58??FU6831\KeilC51\FOC_Fortior.uvgui.Chance

?????文件?????158508??2018-01-27?16:27??FU6831\KeilC51\FOC_Fortior.uvgui.FT1

?????文件?????154252??2018-04-24?19:34??FU6831\KeilC51\FOC_Fortior.uvgui.John?Luo

?????文件??????68203??2018-06-19?15:59??FU6831\KeilC51\FOC_Fortior.uvgui.sam

?????文件?????158657??2018-10-08?13:42??FU6831\KeilC51\FOC_Fortior.uvgui.SMY

?????文件?????149941??2017-06-28?16:41??FU6831\KeilC51\FOC_Fortior.uvgui.VinaPeng

?????文件?????147781??2018-07-27?12:40??FU6831\KeilC51\FOC_Fortior.uvgui_Administrator.bak

?????文件?????147524??2019-04-10?12:43??FU6831\KeilC51\FOC_Fortior.uvgui_Chance.bak

?????文件?????158599??2018-01-10?09:04??FU6831\KeilC51\FOC_Fortior.uvgui_FT1.bak

?????文件?????153731??2018-04-24?11:46??FU6831\KeilC51\FOC_Fortior.uvgui_John?Luo.bak

?????文件??????68203??2018-06-19?15:43??FU6831\KeilC51\FOC_Fortior.uvgui_sam.bak

?????文件?????158536??2018-09-21?19:51??FU6831\KeilC51\FOC_Fortior.uvgui_SMY.bak

?????文件?????149068??2017-06-28?14:50??FU6831\KeilC51\FOC_Fortior.uvgui_VinaPeng.bak

?????文件??????25149??2019-04-10?12:58??FU6831\KeilC51\FOC_Fortior.uvopt

?????文件??????18527??2018-06-27?16:43??FU6831\KeilC51\FOC_Fortior.uvproj

?????文件??????22655??2018-06-13?13:55??FU6831\KeilC51\FOC_Fortior_uvopt.bak

?????文件??????18527??2018-03-09?15:32??FU6831\KeilC51\FOC_Fortior_uvproj.bak

?????文件???????2784??2018-04-24?14:41??FU6831\KeilC51\Ft68ProjCfg.ini

?????文件???????8383??2019-04-10?12:53??FU6831\KeilC51\Listing\ADCInit.lst

?????文件??????75891??2019-04-10?12:55??FU6831\KeilC51\Listing\AddFunction.lst

?????文件???????4361??2019-04-10?12:53??FU6831\KeilC51\Listing\AMPInit.lst

?????文件??????12090??2019-04-10?12:53??FU6831\KeilC51\Listing\BEMFDetect.lst

?????文件???????8672??2019-04-10?12:53??FU6831\KeilC51\Listing\CMPInit.lst

?????文件???????4525??2019-04-10?12:53??FU6831\KeilC51\Listing\DriverInit.lst

?????文件???????4691??2019-04-10?12:53??FU6831\KeilC51\Listing\EXTIInit.lst

?????文件??????17045??2019-04-10?12:53??FU6831\KeilC51\Listing\FocControl.lst

?????文件??????61947??2019-04-10?12:53??FU6831\KeilC51\Listing\FocControlFunction.lst

............此處省略140個文件信息