xushaoxiang
232 lines
7.3 KiB
C
232 lines
7.3 KiB
C
|
|
|
|
#include "Includes.h"
|
|
|
|
|
|
|
|
|
|
#define PULSE_DET_PIN 4 //采样脚（对方通过pwm向此脚灌入百分之五十占空比的方波）
|
|
#define CALIB_TIMES 2 //校准2次
|
|
#define CYCLE_TIMES 3 //循环次数 3次--
|
|
#define COLLECT_NUM ((CYCLE_TIMES*2)-1) //循环3次有六个采样点 可以得到五个采样值
|
|
#define TIMER_REFER 3 //选择的timer3作为计数参考
|
|
#define GEAR_HZ 71160.0 //总共128个档位 每个步长调节71160HZ的频率
|
|
#define RC16M_COEFFI 400 //rc16M 实际频率的计算系数：(1000ms/5ms)*2
|
|
#define RC16M_STD 16000000.0 //rc16M
|
|
void timer_cnt(uint8_t ch)//8 cycle is 1us
|
|
{
|
|
__write_hw_reg32(CPR_CTLAPBCLKEN_GRCTL,0x80008); //TIMER_PCLK 时钟使能
|
|
__write_hw_reg32(CPR_TIMER_CLK_CTL(ch),0x00); //TIMERx_CLK 时钟控制寄存器 mclk_in(rc16M)/(2*(0x00 + 0x1))=8M
|
|
__write_hw_reg32(TIMERx_TCR(ch),0x0); //不屏蔽定时器中断，不使能定时器timer_num，
|
|
__write_hw_reg32(TIMERx_TCR(ch),0x2); //设置定时器工作在用户定义计数模式
|
|
__write_hw_reg32(TIMERx_TLC(ch),0xffffffff); //载入计数器计数初值(32bits),该值应大于等于 0x4
|
|
__write_hw_reg32(TIMERx_TCR(ch),0x3); //使能定时器timer_num
|
|
|
|
}
|
|
|
|
|
|
void BubbleSort(uint32_t *arr,uint32_t length)
|
|
{
|
|
for(int i=0;i<length-1;i++){
|
|
for(int j=0;j<length-1-i;j++){
|
|
if(arr[j]>arr[j+1]){ //相邻两个元素作比较，如果前面元素大于后面，进行交换
|
|
uint32_t temp = arr[j+1];
|
|
arr[j+1] = arr[j];
|
|
arr[j] = temp;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
uint32_t get_average(uint32_t *p,uint32_t len)
|
|
{
|
|
uint32_t sum=0;
|
|
BubbleSort(p,len);
|
|
for(int i=0;i<len-2;i++)
|
|
{
|
|
sum+=p[i+1];
|
|
}
|
|
return sum/(len-2);
|
|
}
|
|
|
|
|
|
void calib_rc16m_step(void)
|
|
{
|
|
float freq_hz;
|
|
uint32_t t1,t2;
|
|
uint32_t rc16m_buf[CYCLE_TIMES*2];
|
|
uint32_t collect_buf[COLLECT_NUM];
|
|
for(int i=0,j=0;i<CYCLE_TIMES;i++)
|
|
{
|
|
while(gpio_input_val(PULSE_DET_PIN)==0);
|
|
rc16m_buf[j++]= *TIMERx_TCV(TIMER_REFER);
|
|
while(gpio_input_val(PULSE_DET_PIN)==1);
|
|
rc16m_buf[j++]= *TIMERx_TCV(TIMER_REFER);
|
|
}
|
|
for(int i=0;i<COLLECT_NUM;i++)
|
|
collect_buf[i]=rc16m_buf[i]-rc16m_buf[i+1];
|
|
freq_hz=RC16M_COEFFI*get_average(collect_buf+1,COLLECT_NUM-1);
|
|
|
|
if(freq_hz>RC16M_STD){
|
|
float tv=(freq_hz - RC16M_STD)/GEAR_HZ;
|
|
uint32_t t1=(((uint32_t)(tv*100))%100)>50 ? 1:0 ;
|
|
CPR_RF_REG0->rc16m_rtune -= (t1+((uint32_t)tv));
|
|
}else if(freq_hz<RC16M_STD){
|
|
float tv=(RC16M_STD-freq_hz)/GEAR_HZ;
|
|
uint32_t t1=(((uint32_t)(tv*100))%100)>50 ? 1:0 ;
|
|
CPR_RF_REG0->rc16m_rtune += (t1+((uint32_t)tv));
|
|
}
|
|
|
|
|
|
}
|
|
void calib_rc16m(void)
|
|
{
|
|
//[00-OSC32M],[01-bbpll direct output],[10-bbpll div output],[11-rc16M]
|
|
*((volatile unsigned *)(0x40000000+ 0x130)) |=0x06; //select clk source rc16M
|
|
|
|
//config pin
|
|
gpio_mux_ctl(PULSE_DET_PIN,0); gpio_fun_inter(PULSE_DET_PIN,0);
|
|
gpio_fun_sel(PULSE_DET_PIN,0); gpio_direction_input(PULSE_DET_PIN,1);//50HZ(10ms)
|
|
__write_hw_reg32((GPIO_DEBOUNCE0+(PULSE_DET_PIN>>4)),((0x10000)<<(PULSE_DET_PIN&0x0F))); //disable debounce
|
|
//CPR_RF_REG0->rc16m_rtune=0x3f;//set rc16m rtune default 0x3f (0-0x7f)
|
|
|
|
//calib start
|
|
timer_cnt(TIMER_REFER);//timer cnt,8 cycle is 1us
|
|
for(int i=0;i<CALIB_TIMES;i++) calib_rc16m_step();//calib 2 timrs , 60ms
|
|
//save calib val to 62 sector offset 32byte
|
|
|
|
|
|
//[00-OSC32M],[01-bbpll direct output],[10-bbpll div output],[11-rc16M]
|
|
*((volatile unsigned *)(0x40000000+ 0x130)) &=~0x06; //select clk source OSC32M
|
|
printf("CPR_RF_REG0->rc16m_rtune=0x%X\n",CPR_RF_REG0->rc16m_rtune);
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#if 0
|
|
|
|
uint32_t rc16m_buf[50];
|
|
void calib_rc16m(void)
|
|
{
|
|
#if 0
|
|
uint32_t t1,t2;
|
|
*((volatile unsigned *)(0x40000000+ 0x130)) |=0x06; //[00-OSC32M],[01-bbpll direct output],[10-bbpll div output],[11-rc16M] //115200
|
|
|
|
CPR_RF_REG0->rc16m_rtune=0x7E;//set rc16m rtune
|
|
gpio_mux_ctl(7,0);gpio_fun_inter(7,0);gpio_fun_sel(7,0); gpio_direction_input(7,1);
|
|
__write_hw_reg32(GPIO_DEBOUNCE0,0xffff0000);
|
|
|
|
xc_timer_init(0,4000000);
|
|
uint8_t timers=50;
|
|
while(gpio_input_val(7)==0);
|
|
while(gpio_input_val(7)==1);
|
|
while(timers--)
|
|
{
|
|
while(gpio_input_val(7)==0);
|
|
t1=*TIMERx_TCV(0);
|
|
while(gpio_input_val(7)==1);
|
|
t2=*TIMERx_TCV(0);
|
|
rc16m_buf[timers]=t1-t2;
|
|
//printf("%d\n",t1-t2);
|
|
while(gpio_input_val(7)==0);
|
|
while(gpio_input_val(7)==1);
|
|
}
|
|
*((volatile unsigned *)(0x40000000+ 0x130)) &=~0x06;
|
|
printf("****\n");
|
|
for(int i=0;i<50;i++) printf("%d\n",rc16m_buf[i]);
|
|
while(1);
|
|
#endif
|
|
#if 0
|
|
uint32_t t1,t2;
|
|
//*((volatile unsigned *)(0x40000000+ 0x130)) |=0x06; //[00-OSC32M],[01-bbpll direct output],[10-bbpll div output],[11-rc16M] //115200
|
|
SET_RC16M_BBPLL_32M();
|
|
CPR_RF_REG0->rc16m_rtune=0xf0;//set rc16m rtune
|
|
gpio_mux_ctl(7,0);gpio_fun_inter(7,0);gpio_fun_sel(7,0); gpio_direction_input(7,1);
|
|
__write_hw_reg32(GPIO_DEBOUNCE0,0xffff0000);
|
|
|
|
xc_timer_init(0,4000000);
|
|
uint8_t timers=50;
|
|
while(gpio_input_val(7)==0);
|
|
while(gpio_input_val(7)==1);
|
|
while(timers--)
|
|
{
|
|
while(gpio_input_val(7)==0);
|
|
t1=*TIMERx_TCV(0);
|
|
while(gpio_input_val(7)==1);
|
|
t2=*TIMERx_TCV(0);
|
|
rc16m_buf[timers]=t1-t2;
|
|
//printf("%d\n",t1-t2);
|
|
while(gpio_input_val(7)==0);
|
|
while(gpio_input_val(7)==1);
|
|
}
|
|
*((volatile unsigned *)(0x40000000+ 0x130)) &=~0x06;
|
|
printf("****\n");
|
|
for(int i=0;i<50;i++) printf("%d\n",rc16m_buf[i]);
|
|
while(1);
|
|
#endif
|
|
}
|
|
|
|
void test_drift_rc16m(void)
|
|
{
|
|
|
|
|
|
}
|
|
|
|
|
|
void test_linear_rc16m(void)
|
|
{
|
|
|
|
|
|
}
|
|
|
|
void test_calib_rc16m(void)
|
|
{
|
|
calib_rc16m();
|
|
//gpio_output_high(26);
|
|
//gpio_output_low(26);
|
|
// //3.19ms
|
|
// calib_init();
|
|
// rc32k_calib(3);
|
|
//gpio_output_high(26);
|
|
//gpio_output_low(26);
|
|
#if 0
|
|
SET_RC16M_BBPLL_32M();
|
|
//CPR_RF_REG0->rc16m_rtune=0x00;//set rc16m rtune uart-89847-bps 415047
|
|
//CPR_RF_REG0->rc16m_rtune=0x20;//set rc16m rtune uart-100401-bps 464796
|
|
//CPR_RF_REG0->rc16m_rtune=0x40;//set rc16m rtune uart-107032-bps 530170
|
|
//CPR_RF_REG0->rc16m_rtune=0x60;//set rc16m rtune uart-134048-bps 619766
|
|
//CPR_RF_REG0->rc16m_rtune=0x80;//set rc16m rtune uart-107101-bps 534492
|
|
//CPR_RF_REG0->rc16m_rtune=0xa0;//set rc16m rtune uart-134124-bps 618613
|
|
// CPR_RF_REG0->rc16m_rtune=0xc0;//set rc16m rtune uart-161290-bps 744983
|
|
// CPR_RF_REG0->rc16m_rtune=0xE0;//set rc16m rtune uart-202839-bps 930793
|
|
// CPR_RF_REG0->rc16m_rtune=0xff;//set rc16m rtune uart-134048-bps 618332
|
|
CPR_RF_REG0->rc16m_rtune=0xf0;//set rc16m rtune uart-231481-bps 1069864
|
|
#endif
|
|
#if 0
|
|
|
|
*((volatile unsigned *)(0x40000000+ 0x130)) |=0x06; //[00-OSC32M],[01-bbpll direct output],[10-bbpll div output],[11-rc16M] //115200
|
|
CPR_RF_REG0->rc16m_rtune=0x00;//set rc16m rtune uart-45004-bps 207574
|
|
// CPR_RF_REG0->rc16m_rtune=0x20;//set rc16m rtune uart-50479-bps 233145
|
|
// CPR_RF_REG0->rc16m_rtune=0x40;//set rc16m rtune uart-57570-bps 266167
|
|
// CPR_RF_REG0->rc16m_rtune=0x60;//set rc16m rtune uart-67114-bps 309918
|
|
// CPR_RF_REG0->rc16m_rtune=0x80;//set rc16m rtune uart-57670-bps 266128
|
|
// CPR_RF_REG0->rc16m_rtune=0xa0;//set rc16m rtune uart-66979-bps 309810
|
|
// CPR_RF_REG0->rc16m_rtune=0xc0;//set rc16m rtune uart-80645-bps 371919
|
|
// CPR_RF_REG0->rc16m_rtune=0xE0;//set rc16m rtune uart-100704-bps 465464
|
|
// CPR_RF_REG0->rc16m_rtune=0xff;//set rc16m rtune uart-134048-bps 618221
|
|
|
|
// *((volatile unsigned *)(0x40002400 + 0x20)) =0x44;
|
|
// *((volatile unsigned *)(0x40002400 + 0x48)) =0x01;
|
|
|
|
#endif
|
|
xc_ao_timer_calib_test();
|
|
|
|
|
|
|
|
|
|
}
|
|
|
|
#endif
|