亚洲情视频,日韩欧美视频,欧美成人精品一区二区三区

/*--------------------------------------------------
無線串口
uart1與NRF24L01P實現
STM32F103C8T6:
IO:
PA0~PA15,
PB0~PB15,
PC13~PC15,
PD0~PD1,
FLASH： 64K
RAM： 20K
外晶振：4~16MHZ
PA3(ADC12.3):AD_ISC
PA4(ADC12.4):AD_ISB
PA5(ADC12.5):AD_ISA
PA9(TXD1)
PA10(RXD1)
PA7(TIM3.2):PWMA
PB0(TIM3.3):PWMB
PB1(TIM3.4):PWMC
資源配置：
UART1：
TIM3.2\TIM3.3\TIM3.4:三路PWM，向下計數模式使PWM后沿對齊，便于同時采樣電流。
注意：
工程路徑修改：
options for target->C/C++->include paths
..\FWlib\inc;.\
兩個點表示上一級目錄，一個點表示與工程相同的目錄
根據電流角度直接指定電壓角度，電機可以反轉，像電扇的同步電機一樣
有必要測量電機的電感、電阻參數，這樣才能估算反電勢，從而得到轉子位置
關于轉子磁鐵的定位：定子線圈的反電勢過零點處對齊磁鐵
20181018:發現獲取電機L、R參數時存在問題，指定MOT_AMP后沒加延時，所以參數不準，反電勢也不準
如果參數準確，反電勢測量準確，則在開環啟動時手捏電機卡死，則測到的反電勢應很小
轉動時的電阻與靜止時的電阻不一樣？
----------------------------------------------------*/
//--------------------------------------------------
// 頭文件
//--------------------------------------------------
#include "stm32f10x.h"
#include "main.h"
//--------------------------------------------------
#define PWA_H IOSET(GPIOA->ODR,BIT(7))
#define PWA_L IOCLR(GPIOA->ODR,BIT(7))
#define PWA_XOR IOXOR(GPIOA->ODR,BIT(7))
#define PWB_H IOSET(GPIOB->ODR,BIT(0))
#define PWB_L IOCLR(GPIOB->ODR,BIT(0))
#define PWB_XOR IOXOR(GPIOB->ODR,BIT(0))
#define PWC_H IOSET(GPIOB->ODR,BIT(1))
#define PWC_L IOCLR(GPIOB->ODR,BIT(1))
#define PWC_XOR IOXOR(GPIOB->ODR,BIT(1))
#define PTEST_H IOSET(GPIOA->ODR,BIT(2))
#define PTEST_L IOCLR(GPIOA->ODR,BIT(2))
#define PTEST_XOR IOXOR(GPIOA->ODR,BIT(2))
//--------------------------------------------------
U16 mainflag=0;
enum {
FLAG_START=BIT(0),
FLAG_RUN=BIT(1)
};
void delayus(U32 t);
U8 myatan(S16 x,S16 y);
U16 GetRegAdc(U8 ch);
//U16 DMA_ADCBuf[DMA_ADCBUFSIZE];
//--------------------------------------------------
// 聲明
//--------------------------------------------------
#include "MOTFOC.C"
#include "uart.c"
#include "stm32f10x_it.c"
//--------------------------------------------------
// 短延時
//--------------------------------------------------
void delay(__IO uint32_t nCount)
{
for(; nCount != 0; nCount--);
}
//--------------------------------------------------
// 微秒延時
//--------------------------------------------------
void delayus(U32 t)
{
U32 i;
for(;t;t--)
{
for(i=8;i;i--);
}
}
//--------------------------------------------------
// 毫秒延時
//--------------------------------------------------
void delayms(U32 t)
{
U32 i;
while(t--)
{
for(i=FOSC/4800;i>0;i--);
}
}
//--------------------------------------------------
//電機發聲
//--------------------------------------------------
/*void Beep(U8 m,U8 t)
{
U16 i,t1;
if(m==0)return;
i=1000/m;
t1=(i+100)*t*m/10;
while(t1--)
{
BEEP_L;
delayus(100);
BEEP_H;
delayus(i);
}
}*/
/*
void Beep(U8 m,U8 t)
{
U16 t1;
t1=6000/(m+6);
beep_td=t;
if(m)
{
TIM_SetAutoreload(TIM4,t1);
TIM_SetCompare1(TIM4,50);
}
}
//等待鳴響完成
void BeepW(U8 m,U8 t)
{
Beep(m,t);
while(beep_td);
}
*/
//--------------------------------------------------
//ADC初始化
//--------------------------------------------------
void ADC_Conf(void)
{
ADC_InitTypeDef ADC_InitStructure;
//DMA_InitTypeDef DMA_InitStructure;
//RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM2, ENABLE);//使能TIM2的RCC時鐘
RCC_APB2PeriphClockCmd(RCC_APB2Periph_ADC1|RCC_APB2Periph_ADC2, ENABLE); // Enable ADC1 and GPIOC clock
ADC_InitStructure.ADC_Mode =ADC_Mode_Independent;//獨立模式 ADC_Mode_RegSimult;//規則同步模式//
ADC_InitStructure.ADC_ScanConvMode = DISABLE;//ENABLE;//掃描模式?
ADC_InitStructure.ADC_ContinuousConvMode = DISABLE;//單次模式//ENABLE;//連續模式
ADC_InitStructure.ADC_ExternalTrigConv =ADC_ExternalTrigConv_None;//由軟件觸發,不由外部觸發 ADC_ExternalTrigConv_T2_CC2; //ADC_ExternalTrigConv_T2_CC2;//定時器2的CC2觸發//
ADC_InitStructure.ADC_DataAlign = ADC_DataAlign_Right;//右對齊
ADC_InitStructure.ADC_NbrOfChannel = 1;
ADC_Init(ADC1, &ADC_InitStructure);
// ADC1 regular channel14 configuration
ADC_RegularChannelConfig(ADC1, ADC_Channel_3, 1, ADC_SampleTime_1Cycles5);
ADC_RegularChannelConfig(ADC1, ADC_Channel_4, 2, ADC_SampleTime_1Cycles5);
ADC_RegularChannelConfig(ADC1, ADC_Channel_5, 3, ADC_SampleTime_1Cycles5);
//ADC_InjectedSequencerLengthConfig(ADC1, 1);//設置注入通道長度
//ADC_InjectedChannelConfig(ADC1, ADC_Channel_3, 1, ADC_SampleTime_13Cycles5);//注入組為一個ADC3
//ADC_ExternalTrigInjectedConvConfig(ADC1, ADC_ExternalTrigInjecConv_None);//不用外觸發
//ADC_SoftwareStartInjectedConvCmd(ADC1, ENABLE);//開始注入通道數據采樣和轉換
// Enable ADC1 DMA
//ADC_DMACmd(ADC1, ENABLE);//使能DMA
//ADC_ExternalTrigConvCmd(ADC1, ENABLE);//使能外部觸發
// Enable ADC1
ADC_Cmd(ADC1, ENABLE);//啟動一次轉換?
// Enable ADC1 reset calibaration register
ADC_ResetCalibration(ADC1);//重置指定ADC的校準寄存器
//Check the end of ADC1 reset calibration register
while(ADC_GetResetCalibrationStatus(ADC1));
// Start ADC1 calibaration
ADC_StartCalibration(ADC1);
// Check the end of ADC1 calibration
while(ADC_GetCalibrationStatus(ADC1));
// Start ADC1 Software Conversion
//ADC_SoftwareStartConvCmd(ADC1, ENABLE);//使能軟件轉換啟動
ADC_Cmd(ADC1, ENABLE);//啟動一次轉換?
}
//--------------------------------------------------
//取得規則組ADC值
//--------------------------------------------------
U16 GetRegAdc(U8 ch)
{
U16 r;
r=ADC1->SQR3;//規則組第一次轉換通道在SQR3低0~4位
r=(r&0xffe0)|ch;
ADC1->SQR3=r;
//ADC_RegularChannelConfig(ADC1, ADC_Channel_3, 1, ADC_SampleTime_7Cycles5);
ADC_SoftwareStartConvCmd(ADC1,ENABLE);
while(!ADC_GetFlagStatus(ADC1,ADC_FLAG_EOC));
return ADC_GetConversionValue(ADC1);
}
//--------------------------------------------------
//等待采集完數據后發送給上位機顯示波形
//--------------------------------------------------
void SendADbuf(void)
{
S16 i;
while(ad_p<ADCBUFSIZE);
for(i=0;i<ADCBUFSIZE;i++)
{
UART1_SendByte(0xaa);
UART1_SendByte(10);
UART1_SendByte(adbuf[0][i]>>8);
UART1_SendByte(adbuf[0][i]);
UART1_SendByte(adbuf[1][i]>>8);
UART1_SendByte(adbuf[1][i]);
UART1_SendByte(adbuf[2][i]>>8);
UART1_SendByte(adbuf[2][i]);
UART1_SendByte(adbuf[3][i]>>8);
UART1_SendByte(adbuf[3][i]);
UART1_SendByte(adbuf[4][i]>>8);
UART1_SendByte(adbuf[4][i]);
}
}
//--------------------------------------------------
// IO口初始化
//--------------------------------------------------
void io_init(void)
{
GPIO_InitTypeDef GPIO_InitStructure;
RCC_APB2PeriphClockCmd( RCC_APB2Periph_GPIOA | RCC_APB2Periph_GPIOB
|RCC_APB2Periph_AFIO,ENABLE); //使能外設時鐘//AFIO用于REMAP
GPIO_PinRemapConfig(GPIO_Remap_SWJ_JTAGDisable,ENABLE);//某些引腳需重映射
//GPIO_PinRemapConfig(GPIO_Remap_SPI1,DISABLE);
GPIO_InitStructure.GPIO_Speed=GPIO_Speed_50MHz;
/*
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP;
GPIO_InitStructure.GPIO_Speed=GPIO_Speed_50MHz;
GPIO_InitStructure.GPIO_Pin = BIT(5)|BIT(7);//SPI1_SCK,SPI1_MOSI
GPIO_Init(GPIOA, &GPIO_InitStructure); */
//AD_ISA,AD_ISB,AD_ISC
GPIO_InitStructure.GPIO_Pin = BIT(5)|BIT(4)|BIT(3);
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AIN;
GPIO_Init(GPIOA, &GPIO_InitStructure);
//PWMA
GPIO_InitStructure.GPIO_Pin = BIT(7);//
GPIO_InitStructure.GPIO_Mode =GPIO_Mode_AF_PP;// GPIO_Mode_Out_PP;
GPIO_Init(GPIOA, &GPIO_InitStructure);
//PTEST
GPIO_InitStructure.GPIO_Pin = BIT(2);//
GPIO_InitStructure.GPIO_Mode =GPIO_Mode_Out_PP;
GPIO_Init(GPIOA, &GPIO_InitStructure);
//PWMB,PWMC
GPIO_InitStructure.GPIO_Pin = BIT(1)|BIT(0);
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP;//GPIO_Mode_Out_PP;
GPIO_Init(GPIOB, &GPIO_InitStructure);
}
//--------------------------------------------------
// 定時器初始化
//APB1=56M/2=28M
//TIM2用于觸發ADC
//TIM3用于定時處理(10KHz)
//TIM4_CH1:蜂鳴器
//--------------------------------------------------
void Timer_Init(void)
{
TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure;
TIM_OCInitTypeDef TIM_OCInitStructure;
TIM_TimeBaseStructure.TIM_Period= 256-1; //自動重裝值,為0時不工作
TIM_TimeBaseStructure.TIM_Prescaler= 10-1; //時鐘頻率預分頻(變為1M)
//向上計數:0~TIM_Period 向下計數:TIM_Period~0
//TIM_TimeBaseStructure.TIM_CounterMode= TIM_CounterMode_Up; //向上計數模式
TIM_TimeBaseStructure.TIM_CounterMode= TIM_CounterMode_Down; //向下計數模式
TIM_TimeBaseStructure.TIM_ClockDivision= TIM_CKD_DIV1; //時鐘分頻因子
RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM3, ENABLE);//使能TIM3的RCC時鐘
TIM_DeInit(TIM3);
TIM_TimeBaseInit(TIM3,&TIM_TimeBaseStructure);
TIM_InternalClockConfig(TIM3);//由內部提供時鐘.
TIM_ITConfig(TIM3,TIM_IT_Update,ENABLE);//使能更新事件中斷
TIM_Cmd(TIM3,ENABLE); //使能定時器
TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM1;//TIM_OCMode_Toggle// 輸出比較觸發模式
TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable;//貌似必須設置為輸出才行
TIM_OCInitStructure.TIM_Pulse = 100;//
TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High;
TIM_OC2Init(TIM3, &TIM_OCInitStructure);
TIM_OC3Init(TIM3, &TIM_OCInitStructure);
TIM_OC4Init(TIM3, &TIM_OCInitStructure);
TIM3->CCR2=0;
TIM3->CCR3=40;
TIM3->CCR4=255;
//TIM_OC2PreloadConfig(TIM2, TIM_OCPreload_Disable);
//TIM_PrescalerConfig(TIM2,1,TIM_PSCReloadMode_Immediate);//立即裝入預分頻
//TIM_ITConfig(TIM2,TIM_IT_CC2,ENABLE);//使能TIM2捕獲\比較中斷
}
//--------------------------------------------------
// NVIC初始化
//--------------------------------------------------
void NVIC_Configuration(void)
{
NVIC_InitTypeDef NVIC_InitStructure;
//EXTI_InitTypeDef EXTI_InitStructure;
NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);
NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 3;//占先
NVIC_InitStructure.NVIC_IRQChannelSubPriority = 0; //
NVIC_InitStructure.NVIC_IRQChannel = TIM3_IRQn; //選擇TIM3中斷
NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 3;//
NVIC_InitStructure.NVIC_IRQChannelSubPriority = 0; //
NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;//使能
NVIC_Init(&NVIC_InitStructure);
NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 2;//占先
NVIC_InitStructure.NVIC_IRQChannel = USART1_IRQn;
NVIC_Init(&NVIC_InitStructure);
}
//--------------------------------------------------
//使用HSI:8/2*16=64MHZ
//--------------------------------------------------
void RCC_Configuration(void)
{
RCC_DeInit();
RCC_HSICmd(ENABLE);
while(RCC_GetFlagStatus(RCC_FLAG_HSIRDY) == RESET)
{
}
FLASH_PrefetchBufferCmd(FLASH_PrefetchBuffer_Enable);
FLASH_SetLatency(FLASH_Latency_2);
RCC_HCLKConfig(RCC_SYSCLK_Div1); //AHB時鐘為系統時鐘SYSCLK
RCC_PCLK2Config(RCC_HCLK_Div1); //APB1時鐘為HCLK/2，其中HCLK為AHB時鐘
RCC_PCLK1Config(RCC_HCLK_Div2); //APB2時鐘為HCLK
//設置 PLL 時鐘源及倍頻系數
RCC_PLLConfig(RCC_PLLSource_HSI_Div2, RCC_PLLMul_16); //8/2*16=64MHZ
//使能或者失能 PLL,這個參數可以取：ENABLE或者DISABLE
RCC_PLLCmd(ENABLE);//如果PLL被用于系統時鐘,那么它不能被失能
//等待指定的 RCC 標志位設置成功等待PLL初始化成功
while(RCC_GetFlagStatus(RCC_FLAG_PLLRDY) == RESET)
{
}
//設置系統時鐘（SYSCLK）設置PLL為系統時鐘源
RCC_SYSCLKConfig(RCC_SYSCLKSource_PLLCLK);
//等待PLL成功用作于系統時鐘的時鐘源
// 0x00：HSI 作為系統時鐘
// 0x04：HSE作為系統時鐘
// 0x08：PLL作為系統時鐘
while(RCC_GetSYSCLKSource() != 0x08)
{
}
//RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA | RCC_APB2Periph_GPIOB |
//RCC_APB2Periph_GPIOC | RCC_APB2Periph_AFIO, ENABLE);
}
//--------------------------------------------------
// 初始化所有的設備
//--------------------------------------------------
void init_devices(void)
{
//SystemInit();
RCC_Configuration();
io_init();
UART_Config(38400);
Timer_Init();
ADC_Conf();
NVIC_Configuration();
delayms(100);
//LCD_Init();
}
//--------------------------------------------------
// 主函數
//--------------------------------------------------
int main(void)
{
S16 i=1,u,v,w,x,y;
U8 p;
init_devices();
/*
//------------------------------myatan驗證
for(i=0;i<256;i++)//一周期
{
p=i;
u=costab[p];
p-=256/3;//360度/3=120度
v=costab[p];
p-=256/3;//360度/3=120度
w=costab[p];
x=myatan(u,v);
UART1_SendByte(0xaa);
UART1_SendByte(8);
UART1_SendByte(u>>8);
UART1_SendByte(u);
UART1_SendByte(v>>8);
UART1_SendByte(v);
UART1_SendByte(w>>8);
UART1_SendByte(w);
UART1_SendByte(x>>8);
UART1_SendByte(x);
}
//------------------------------Clarke變換驗證
for(i=0;i<256;i++)//一周期
{
p=i;
u=costab[p];
p-=256/3;//360度/3=120度
v=costab[p];
ClarkeTrans(u,v,&x,&y);
x+=10;//偏移10以免波形重疊
y+=10;
UART1_SendByte(0xaa);
UART1_SendByte(8);
UART1_SendByte(u>>8);
UART1_SendByte(u);
UART1_SendByte(v>>8);
UART1_SendByte(v);
UART1_SendByte(x>>8);
UART1_SendByte(x);
UART1_SendByte(y>>8);
UART1_SendByte(y);
}
//------------------------------Clarke逆變換驗證
for(i=0;i<256;i++)//一周期
{
p=i;
u=costab[p];
p-=256/3;//360度/3=120度
v=costab[p];
ClarkeTrans(u,v,&x,&y);
ClarkeInvTrans(x,y,&u,&v,&w);
x+=10;//偏移10以免波形重疊
y+=10;
UART1_SendByte(0xaa);
UART1_SendByte(8);
UART1_SendByte(u>>8);
UART1_SendByte(u);
UART1_SendByte(v>>8);
UART1_SendByte(v);
UART1_SendByte(x>>8);
UART1_SendByte(x);
UART1_SendByte(y>>8);
UART1_SendByte(y);
}
//------------------------------Park變換驗證
for(i=0;i<256;i++)//一周期
{
p=0;//u\v固定為0度
u=costab[p];
p-=256/4;//360度/4=90度
v=costab[p];
ParkTrans(u,v,i,&x,&y);//Park變換(旋轉i度(2PI=256))
UART1_SendByte(0xaa);
UART1_SendByte(8);
UART1_SendByte(u>>8);
UART1_SendByte(u);
UART1_SendByte(v>>8);
UART1_SendByte(v);
UART1_SendByte(x>>8);
UART1_SendByte(x);
UART1_SendByte(y>>8);
UART1_SendByte(y);
}
//i=1;
//while(i);
delayms(3000);// */
//------------------------------電流校零
Mot_State=0;
delayms(10);
Mot_State=1;
delayms(10);//等待電流校零
//------------------------------獲取電機參數
//指定相電壓
Mot_AMP=(7*256/47);//需要0.5V，電源4.7V
Mot_State=2;//取得電機參數
delayms(100);//由于電機會略有轉動，等長一點時間后重新采集數據
Mot_State=0;//停止
delayms(1); //等到續流為0后再開始采集
ad_p=0;//開始采集數據
Mot_State=2;//取得電機參數
delayms(100);//iu=0,42,68,...,109
while(ad_p<ADCBUFSIZE);//等數據采集完
Mot_State=0;
if(adbuf[0][1]==adbuf[0][0])//防止除數為0
adbuf[0][1]=adbuf[0][0]+1;
Mot_L=(U16)Mot_AMP*100/(adbuf[0][1]-adbuf[0][0]);//表示pwm=1時每周期的電流增量*100
Mot_R=(U16)Mot_AMP*100/adbuf[0][ADCBUFSIZE-1];//表示PWM每變化1時電流的變化量*100
adbuf[3][ADCBUFSIZE-1]=Mot_L;//在上位機中查看此數據
adbuf[4][ADCBUFSIZE-1]=Mot_R;
/*
SendADbuf();//發給上位機查看波形
//------------------------------驗證電感、電阻計算公式
Mot_AMP=(5*256/47);//相電壓0.5V
Mot_State=2;//取得電機參數
delayms(50);//由于電機會略有轉動，等長一點時間后重新采集數據
Mot_State=0;//停止
delayms(1);
ad_p=0;//開始采集數據
Mot_State=2;//取得電機參數
delayms(20);//iu=0,42,68,...,109
Mot_State=0;
SendADbuf();// */
//------------------------------
Mot_State=0;
delayms(1);
//------------------------------開環啟動
Mot_AMP=45;
ad_p=0;
Mot_State=3;//開環啟動
SendADbuf();
delayms(1000);
ad_p=0;
SendADbuf();
ad_p=0;
while(ad_p<ADCBUFSIZE/3);
Mot_State=4;//開始閉環
SendADbuf();
while(1)
{
ad_p=0;
SendADbuf();
delayms(2000);
}
/* while(1)//調壓
{
Mot_AMP=50;delayms(2000);
ad_p=0;
SendADbuf();
Mot_AMP=150;delayms(2000);
ad_p=0;
SendADbuf();
} */
}
#ifdef USE_FULL_ASSERT
/**
* @brief Reports the name of the source file and the source line number
* where the assert_param error has occurred.
* @param file: pointer to the source file name
* @param line: assert_param error line source number
* @retval : None
*/
void assert_failed(uint8_t* file, uint32_t line)
{
/* User can add his own implementation to report the file name and line number,
ex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */
/* Infinite loop */
while (1){}
}
#endif

復制代碼

久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费