/****************************?（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?

/*?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};
/*---------------------------------------------------------------------------*/
/*?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;	
}
/*---------------------------------------------------------------------------*/
/*?Name		:	void?TailWindParInit（void）
/*?Input	:	NO
/*?Output	:	NO
/*?Description:	逆風啟動的變量初始化
/*---------------------------------------------------------------------------*/
void?TailWindParInit（void）
{
	TailWindDetect.TailWindSpeed?=0;
	TailWindDetect.MotorDir	=?0;
	TailWindDetect.AngleState?=0;
	TailWindDetect.Moto

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

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

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

?????文件?????146420??2016-09-22?10:19??FU68XX_IPM\FU68XX_-?demo\KeilC51\FOC_Fortior.uvgui.Administrator

?????文件?????154106??2015-12-31?17:08??FU68XX_IPM\FU68XX_-?demo\KeilC51\FOC_Fortior.uvgui.John?Luo

????.......????145233??2017-03-22?11:56??FU68XX_IPM\FU68XX_-?demo\KeilC51\FOC_Fortior.uvgui.VinaPeng

?????文件?????146310??2016-09-21?19:20??FU68XX_IPM\FU68XX_-?demo\KeilC51\FOC_Fortior.uvgui_Administrator.bak

?????文件?????154440??2015-12-29?11:22??FU68XX_IPM\FU68XX_-?demo\KeilC51\FOC_Fortior.uvgui_John?Luo.bak

????.......????145233??2017-03-22?11:56??FU68XX_IPM\FU68XX_-?demo\KeilC51\FOC_Fortior.uvgui_VinaPeng.bak

????.......?????21350??2017-03-22?11:56??FU68XX_IPM\FU68XX_-?demo\KeilC51\FOC_Fortior.uvopt

?????文件??????18521??2016-09-21?16:21??FU68XX_IPM\FU68XX_-?demo\KeilC51\FOC_Fortior.uvproj

?????文件???????6779??2017-03-15?16:08??FU68XX_IPM\FU68XX_-?demo\KeilC51\Listing\ADCInit.lst

?????文件??????64556??2017-03-22?11:56??FU68XX_IPM\FU68XX_-?demo\KeilC51\Listing\AddFunction.lst

?????文件???????4197??2017-03-15?16:07??FU68XX_IPM\FU68XX_-?demo\KeilC51\Listing\AMPInit.lst

?????文件??????12385??2017-03-15?16:07??FU68XX_IPM\FU68XX_-?demo\KeilC51\Listing\BEMFDetect.lst

?????文件???????7812??2017-03-15?16:08??FU68XX_IPM\FU68XX_-?demo\KeilC51\Listing\CMPInit.lst

?????文件???????4515??2017-03-15?16:08??FU68XX_IPM\FU68XX_-?demo\KeilC51\Listing\DriverInit.lst

?????文件???????4677??2017-03-15?16:08??FU68XX_IPM\FU68XX_-?demo\KeilC51\Listing\EXTIInit.lst

?????文件??????12750??2017-03-15?16:07??FU68XX_IPM\FU68XX_-?demo\KeilC51\Listing\FocControl.lst

?????文件??????52005??2017-03-15?16:07??FU68XX_IPM\FU68XX_-?demo\KeilC51\Listing\FocControlFunction.lst

?????文件???????2768??2017-03-15?16:08??FU68XX_IPM\FU68XX_-?demo\KeilC51\Listing\FocSpiInit.lst

?????文件?????482338??2017-03-22?11:56??FU68XX_IPM\FU68XX_-?demo\KeilC51\Listing\FOC_Youyanji.map

?????文件???????3248??2017-03-15?16:08??FU68XX_IPM\FU68XX_-?demo\KeilC51\Listing\GPIOInit.lst

?????文件??????16335??2017-03-15?16:07??FU68XX_IPM\FU68XX_-?demo\KeilC51\Listing\Interrupt.lst

?????文件???????8620??2017-03-15?16:07??FU68XX_IPM\FU68XX_-?demo\KeilC51\Listing\main.lst

?????文件???????6067??2017-03-15?16:08??FU68XX_IPM\FU68XX_-?demo\KeilC51\Listing\MDUInit.lst

?????文件???????2502??2017-03-15?16:08??FU68XX_IPM\FU68XX_-?demo\KeilC51\Listing\PIInit.lst

?????文件??????41555??2016-09-21?14:54??FU68XX_IPM\FU68XX_-?demo\KeilC51\Listing\PosiCheck.lst

?????文件???????7743??2017-03-15?16:08??FU68XX_IPM\FU68XX_-?demo\KeilC51\Listing\SPIInit.lst

?????文件???????4631??2017-03-15?16:08??FU68XX_IPM\FU68XX_-?demo\KeilC51\Listing\SystemInit.lst

?????文件??????39266??2017-03-15?16:08??FU68XX_IPM\FU68XX_-?demo\KeilC51\Listing\TimerInit.lst

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