575 lines
15 KiB
C
575 lines
15 KiB
C
#include "device_adc_collect.h"
|
||
|
||
|
||
// ADC_Phase_current H_ADC_Collect;
|
||
// ADC_Phase_current V_ADC_Collect;
|
||
|
||
//发送云台工作电压
|
||
void ptz_send_voltage(char dev)
|
||
{
|
||
unsigned short int vol = 0;
|
||
unsigned char VData[7]= {0xff,0x00,0x00,0x00,0x00,0x00,0x00};
|
||
vol = ( unsigned short int)(g_ptz.Voltage * 100 + 0.5);
|
||
VData[1] = g_ptz.address;
|
||
VData[2] = 0xcd;
|
||
VData[3] = (unsigned char)(vol >> 8);
|
||
VData[4] = (unsigned char)(vol & 0x00ff);
|
||
VData[6] = MotorCalPelcoDSUM(VData,sizeof(VData));
|
||
ptz_send_data(dev, VData, sizeof(VData));
|
||
//发送调试数据
|
||
}
|
||
|
||
//发送云台工作电流
|
||
void ptz_send_current(char dev)
|
||
{
|
||
unsigned short int current = 0;
|
||
unsigned char IData[7]= {0xff,0x00,0x00,0x00,0x00,0x00,0x00};
|
||
current = (unsigned short int)(g_ptz.electric_current * 100 + 0.5);
|
||
IData[1] = g_ptz.address;
|
||
IData[2] = 0xc8;
|
||
IData[3] = (unsigned char)(current >> 8);
|
||
IData[4] = (unsigned char)(current & 0x00ff);
|
||
IData[6] = MotorCalPelcoDSUM(IData,sizeof(IData));
|
||
|
||
ptz_send_data(dev, IData, sizeof(IData));
|
||
}
|
||
|
||
// //发送云台温度
|
||
// void ptz_send_temperature(char dev)
|
||
// {
|
||
// unsigned short int tem = 0;
|
||
// unsigned char TData[7]= {0xff,0x00,0x00,0x00,0x00,0x00,0x00};
|
||
// tem = (unsigned short int)(g_ptz.temperature * 100 + 0.5);
|
||
// TData[1] = g_ptz.address;
|
||
// TData[2] = 0xd6;
|
||
// TData[3] = (unsigned char)(tem >> 8);
|
||
// TData[4] = (unsigned char)(tem & 0x00ff);
|
||
// TData[6] = MotorCalPelcoDSUM(TData,sizeof(TData));
|
||
|
||
// ptz_send_data(dev,TData,sizeof(TData));
|
||
|
||
// }
|
||
|
||
|
||
// //发送全桥驱动电路温度
|
||
// void ptz_send_bridge_temperature(char dev)
|
||
// {
|
||
// unsigned short int tem = 0;
|
||
// unsigned char TData[7]= {0xff,0x00,0x00,0x00,0x00,0x00,0x00};
|
||
// //发送水平驱动侧
|
||
// tem = (unsigned short int)(g_ptz.H_boad_temp * 100 + 0.5);
|
||
// TData[1] = g_ptz.address;
|
||
// TData[2] = 0xd7;
|
||
// TData[3] = PTZ_HORI;
|
||
// TData[4] = (unsigned char)(tem >> 8);
|
||
// TData[5] = (unsigned char)(tem & 0x00ff);
|
||
// TData[6] = MotorCalPelcoDSUM(TData,sizeof(TData));
|
||
|
||
// ptz_send_data(dev,TData,sizeof(TData));
|
||
|
||
// OSTimeDlyHMSM(0u, 0u, 0u, 5u);
|
||
|
||
// //发送垂直驱动侧
|
||
// tem = (unsigned short int)(g_ptz.V_boad_temp * 100 + 0.5);
|
||
// TData[1] = g_ptz.address;
|
||
// TData[2] = 0xd7;
|
||
// TData[3] = PTZ_VERT;
|
||
// TData[4] = (unsigned char)(tem >> 8);
|
||
// TData[5] = (unsigned char)(tem & 0x00ff);
|
||
// TData[6] = MotorCalPelcoDSUM(TData,sizeof(TData));
|
||
|
||
// ptz_send_data(dev,TData,sizeof(TData));
|
||
|
||
// }
|
||
|
||
|
||
|
||
|
||
// static float current_caculate(uint16_t I)
|
||
// {
|
||
// float i;
|
||
// i = ((float)I/4096.0*3.3)/0.5;
|
||
// return i;
|
||
// }
|
||
|
||
|
||
|
||
// /*!
|
||
// \brief ADC2初始化,水平电机相电流采集
|
||
// \param[in] none
|
||
// \param[out] none
|
||
// \retval none
|
||
// \note LH @2022.07.21
|
||
// */
|
||
// static void ADC2_Init()
|
||
// {
|
||
// /* 水平电机相电流：PC0-U，PA0-V，PA3-W ---ADC2*/
|
||
// //配置引脚时钟
|
||
// rcu_periph_clock_enable(RCU_GPIOA);
|
||
// rcu_periph_clock_enable(RCU_GPIOC);
|
||
// gpio_mode_set(GPIOC,GPIO_MODE_ANALOG,GPIO_PUPD_NONE,GPIO_PIN_0);
|
||
// gpio_mode_set(GPIOA,GPIO_MODE_ANALOG,GPIO_PUPD_NONE,GPIO_PIN_0);
|
||
// gpio_mode_set(GPIOA,GPIO_MODE_ANALOG,GPIO_PUPD_NONE,GPIO_PIN_3);
|
||
|
||
|
||
// rcu_periph_clock_enable(RCU_ADC2);
|
||
// //总线时钟20分频=6MHZ
|
||
// adc_clock_config(ADC_ADCCK_PCLK2_DIV4);
|
||
// /***********************************************/
|
||
|
||
// //对齐方式 ADC_INSERTED_CHANNEL
|
||
// adc_data_alignment_config(ADC2,ADC_DATAALIGN_RIGHT);
|
||
// //扫描模式
|
||
// adc_special_function_config(ADC2,ADC_SCAN_MODE,ENABLE);
|
||
// //外部触发关闭
|
||
// adc_external_trigger_config(ADC2,ADC_INSERTED_CHANNEL,DISABLE);
|
||
// //采集通道数
|
||
// adc_channel_length_config(ADC2,ADC_INSERTED_CHANNEL,3);
|
||
|
||
// //通道注入顺序
|
||
// adc_inserted_channel_config(ADC2,0,ADC_CHANNEL_10,ADC_SAMPLETIME_480);//u
|
||
// adc_inserted_channel_config(ADC2,1,ADC_CHANNEL_0,ADC_SAMPLETIME_480);//v
|
||
// adc_inserted_channel_config(ADC2,2,ADC_CHANNEL_3,ADC_SAMPLETIME_480);//w
|
||
|
||
// adc_enable(ADC2);
|
||
|
||
// adc_calibration_enable(ADC2);
|
||
// }
|
||
|
||
|
||
// /*!
|
||
// \brief ADC0初始化,垂直电机相电流采集
|
||
// \param[in] none
|
||
// \param[out] none
|
||
// \retval none
|
||
// \note LH @2022.07.21
|
||
// */
|
||
// static void ADC0_Init()
|
||
// {
|
||
// /* 垂直电机相电流：PA4-U，PA5-V，PA6-W ---ADC0*/
|
||
// //配置引脚时钟
|
||
// rcu_periph_clock_enable(RCU_GPIOA);
|
||
// gpio_mode_set(GPIOA,GPIO_MODE_ANALOG,GPIO_PUPD_NONE,GPIO_PIN_4);
|
||
// gpio_mode_set(GPIOA,GPIO_MODE_ANALOG,GPIO_PUPD_NONE,GPIO_PIN_5);
|
||
// gpio_mode_set(GPIOA,GPIO_MODE_ANALOG,GPIO_PUPD_NONE,GPIO_PIN_6);
|
||
|
||
|
||
// rcu_periph_clock_enable(RCU_ADC0);
|
||
// //总线时钟20分频=6MHZ
|
||
// adc_clock_config(ADC_ADCCK_PCLK2_DIV4);
|
||
// /***********************************************/
|
||
|
||
// //对齐方式 ADC_INSERTED_CHANNEL
|
||
// adc_data_alignment_config(ADC0,ADC_DATAALIGN_RIGHT);
|
||
// //扫描模式
|
||
// adc_special_function_config(ADC0,ADC_SCAN_MODE,ENABLE);
|
||
// //外部触发关闭
|
||
// adc_external_trigger_config(ADC0,ADC_INSERTED_CHANNEL,DISABLE);
|
||
// //采集通道数
|
||
// adc_channel_length_config(ADC0,ADC_INSERTED_CHANNEL,3);
|
||
|
||
// //通道注入顺序
|
||
// adc_inserted_channel_config(ADC0,0,ADC_CHANNEL_4,ADC_SAMPLETIME_480);//u
|
||
// adc_inserted_channel_config(ADC0,1,ADC_CHANNEL_5,ADC_SAMPLETIME_480);//v
|
||
// adc_inserted_channel_config(ADC0,2,ADC_CHANNEL_6,ADC_SAMPLETIME_480);//w
|
||
|
||
// adc_enable(ADC0);
|
||
|
||
// adc_calibration_enable(ADC0);
|
||
// }
|
||
|
||
|
||
/* H_NTC-PB0 ,V_NTC-PB1 ----ADC1*/
|
||
/*!
|
||
\brief ADC1初始化,电压,电流,NTC温度采集
|
||
\param[in] none
|
||
\param[out] none
|
||
\retval none
|
||
\note LH @2022.07.21
|
||
*/
|
||
// static void ADC1_Init()
|
||
// {
|
||
// //配置引脚时钟
|
||
// rcu_periph_clock_enable(RCU_GPIOC);
|
||
// // rcu_periph_clock_enable(RCU_GPIOB);
|
||
// //引脚复用，PC2——电压ADC1-CH12，PC3——电流ADC1-CH13
|
||
// gpio_mode_set(GPIOC,GPIO_MODE_ANALOG,GPIO_PUPD_NONE,GPIO_PIN_2);
|
||
// gpio_mode_set(GPIOC,GPIO_MODE_ANALOG,GPIO_PUPD_NONE,GPIO_PIN_3);
|
||
// // /* H_NTC-PB0 ,V_NTC-PB1 */
|
||
// // gpio_mode_set(GPIOB,GPIO_MODE_ANALOG,GPIO_PUPD_NONE,GPIO_PIN_0);
|
||
// // gpio_mode_set(GPIOB,GPIO_MODE_ANALOG,GPIO_PUPD_NONE,GPIO_PIN_1);
|
||
|
||
|
||
// rcu_periph_clock_enable(RCU_ADC1);
|
||
// //总线时钟20分频=6MHZ
|
||
// adc_clock_config(ADC_ADCCK_PCLK2_DIV4);
|
||
// /***********************************************/
|
||
|
||
// //对齐方式 ADC_INSERTED_CHANNEL
|
||
// adc_data_alignment_config(ADC1,ADC_DATAALIGN_RIGHT);
|
||
// //扫描模式
|
||
// adc_special_function_config(ADC1,ADC_SCAN_MODE,ENABLE);
|
||
// //外部触发关闭
|
||
// adc_external_trigger_config(ADC1,ADC_INSERTED_CHANNEL,DISABLE);
|
||
// //采集通道数
|
||
// adc_channel_length_config(ADC1,ADC_INSERTED_CHANNEL,2);
|
||
|
||
// //通道注入顺序
|
||
// adc_inserted_channel_config(ADC1,0,ADC_CHANNEL_13,ADC_SAMPLETIME_480);//电流
|
||
// adc_inserted_channel_config(ADC1,1,ADC_CHANNEL_12,ADC_SAMPLETIME_480);//电压
|
||
// // adc_inserted_channel_config(ADC1,2,ADC_CHANNEL_8,ADC_SAMPLETIME_480);//H_NTC-PB0
|
||
// // adc_inserted_channel_config(ADC1,3,ADC_CHANNEL_9,ADC_SAMPLETIME_480);//V_NTC-PB1
|
||
|
||
|
||
// adc_enable(ADC1);
|
||
|
||
// adc_calibration_enable(ADC1);
|
||
// }
|
||
|
||
|
||
|
||
// /*!
|
||
// \brief 水平电机相电流采集
|
||
// \param[in] none
|
||
// \param[out] none
|
||
// \retval none
|
||
// \note LH @2022.07.19
|
||
// */
|
||
// void H_ADC2_Phase_current()
|
||
// {
|
||
// adc_software_trigger_enable(ADC2,ADC_INSERTED_CHANNEL);
|
||
// asm ("nop");
|
||
// asm ("nop");
|
||
// H_ADC_Collect.Phase_curr_U = current_caculate(ADC_IDATA0(ADC2));//U
|
||
// asm ("nop");
|
||
// H_ADC_Collect.Phase_curr_V = current_caculate(ADC_IDATA1(ADC2));//V
|
||
// asm ("nop");
|
||
// H_ADC_Collect.Phase_curr_W = current_caculate(ADC_IDATA2(ADC2));//W
|
||
|
||
// }
|
||
|
||
|
||
// /*!
|
||
// \brief 垂直电机相电流采集
|
||
// \param[in] none
|
||
// \param[out] none
|
||
// \retval none
|
||
// \note LH @2022.07.19
|
||
// */
|
||
// void V_ADC0_Phase_current()
|
||
// {
|
||
// // int Ia,Ib,Ic;
|
||
// adc_software_trigger_enable(ADC0,ADC_INSERTED_CHANNEL);
|
||
// asm ("nop");
|
||
// asm ("nop");
|
||
// // Ia = ADC_IDATA0(ADC0);//U
|
||
// V_ADC_Collect.Phase_curr_U = current_caculate(ADC_IDATA0(ADC0));//U
|
||
// asm ("nop");
|
||
// // Ib = ADC_IDATA1(ADC0);//V
|
||
// V_ADC_Collect.Phase_curr_V = current_caculate(ADC_IDATA1(ADC0));//V
|
||
// asm ("nop");
|
||
// // Ic = ADC_IDATA2(ADC0);//W
|
||
// V_ADC_Collect.Phase_curr_W = current_caculate(ADC_IDATA2(ADC0));//W
|
||
|
||
// }
|
||
|
||
|
||
|
||
|
||
// #define R_constant 10.0 //千欧姆——分压电阻值
|
||
|
||
// #define R_25 10000.0//热敏电阻常温下的电阻值
|
||
|
||
// #define Ntc_B 3435.0//常量B
|
||
|
||
// #define Kelvin_temp 273.15+25//常温——开尔文温度
|
||
// //NTC电流
|
||
// static float Ntc_current(uint16_t data)
|
||
// {
|
||
// static float curr;
|
||
// curr = ((float)data / 4096.0 * 3.3)/R_constant;
|
||
// return curr;
|
||
|
||
// }
|
||
// //NTC电压
|
||
// static float Ntc_voltage(uint16_t data)
|
||
// {
|
||
// static float voltage;
|
||
// voltage = 3.3 - ((float)data / 4096.0 * 3.3);
|
||
// return voltage;
|
||
// }
|
||
// //NTC电阻
|
||
// static float Ntc_resis(uint16_t data)
|
||
// {
|
||
// static float resis,curr,voltage;
|
||
// curr = Ntc_current(data);
|
||
// voltage = Ntc_voltage(data);
|
||
// resis = voltage / curr * 1000.0;//因为电流值放大了1000倍
|
||
// return resis;
|
||
// }
|
||
|
||
|
||
|
||
|
||
// //NTC温度计算,开尔文温度
|
||
// static float Ntc_temp(uint16_t adc_data)
|
||
// {
|
||
// float R_ntc;//实际电阻
|
||
// double temp,K,j,l,m;//实际温度
|
||
// R_ntc = Ntc_resis(adc_data);
|
||
// K = R_ntc/10000.0;
|
||
// j = log(K);//log e为底数
|
||
// l = j/3435.0;
|
||
// m = 1.0 /298.15;
|
||
// temp = 1/(l+m);
|
||
// // temp = 1/(j / Ntc_B + 1/Kelvin_temp);
|
||
// return (float)temp;
|
||
// }
|
||
|
||
|
||
// /*!
|
||
// \brief 热敏电阻计算主板温度
|
||
// \param[in] none
|
||
// \param[out] none
|
||
// \retval none
|
||
// \note LH @2022.07.19
|
||
// */
|
||
// static void Ntc_value()//ADC1
|
||
// {
|
||
// float H_temp_f,V_temp_f;//初始温度,开尔文温度
|
||
// short int H_temp,V_temp;//矫正温度,摄氏温度
|
||
|
||
// adc_software_trigger_enable(ADC1,ADC_INSERTED_CHANNEL);
|
||
// asm ("nop");
|
||
// asm ("nop");
|
||
// H_temp_f = Ntc_temp(ADC_IDATA2(ADC1));
|
||
// asm ("nop");
|
||
// asm ("nop");
|
||
// V_temp_f = Ntc_temp(ADC_IDATA3(ADC1));
|
||
|
||
// H_temp = (short int)(H_temp_f - 273.15 + 0.5);
|
||
|
||
// V_temp = (short int)(V_temp_f - 273.15 + 0.5);
|
||
|
||
// g_ptz.H_boad_temp = (float)H_temp;//该温度参数需要增加回传与查询
|
||
|
||
// g_ptz.V_boad_temp = (float)V_temp;
|
||
|
||
// }
|
||
|
||
|
||
// //电压采集
|
||
// static void ptz_Voltage_collect_adc1_task()
|
||
// {
|
||
// static float adc1_v[5];
|
||
// static unsigned char adc1_num;
|
||
// int j,k;
|
||
// float tem;
|
||
// float curadc1;
|
||
// uint16_t value_V;
|
||
// //软件触发使能
|
||
// adc_software_trigger_enable(ADC1,ADC_INSERTED_CHANNEL);
|
||
// value_V = ADC_IDATA1(ADC1);
|
||
|
||
// // adc1_v[adc1_num] = (float)value_V / 4096.0 * 11 *3.38;
|
||
// adc1_v[adc1_num] = (float)value_V / 4096.0 * 12.55 *3.38;
|
||
// adc1_num++;
|
||
// if(adc1_num >= 5)
|
||
// {
|
||
// adc1_num = 0;
|
||
// for(j = 0; j < 5-1; j++)//采样值由小到大排列
|
||
// {
|
||
// for(k = 0; k < 5-j-1; k++)
|
||
// {
|
||
// if(adc1_v[k] > adc1_v[k+1])
|
||
// {
|
||
// tem = adc1_v[k];
|
||
// adc1_v[k] = adc1_v[k+1];
|
||
// adc1_v[k+1] = tem;
|
||
// }
|
||
// }
|
||
// }
|
||
// for(uint8_t i = 1; i < 5 - 1; i++)
|
||
// {
|
||
// curadc1 = curadc1 + adc1_v[i];
|
||
// }
|
||
// curadc1 = curadc1 /((float)(5 - 2));//去掉一个最大值和一个最小值求平均值
|
||
// g_ptz.Voltage = curadc1;
|
||
// memset(adc1_v,0,sizeof(adc1_v));
|
||
// // pdebug(DEBUG_LEVEL_INFO,"get ptz Voltage: %.3fV",g_ptz.Voltage);
|
||
// }
|
||
|
||
// }
|
||
|
||
// //电流采集
|
||
// static void ptz_Current_collect_adc1_task()
|
||
// {
|
||
// static float adc1_i[5];
|
||
// static unsigned char adc0_num;
|
||
// int j,k;
|
||
// float tem;
|
||
// float curadc0;
|
||
// uint16_t value_I;
|
||
|
||
// adc_software_trigger_enable(ADC1,ADC_INSERTED_CHANNEL);
|
||
// value_I = ADC_IDATA0(ADC1);
|
||
|
||
// adc1_i[adc0_num] = ((float)value_I / 4096.0 * 3.38) * 10;//(float)value_I;//
|
||
|
||
// adc0_num ++;
|
||
// if(adc0_num >= 5)
|
||
// {
|
||
// adc0_num = 0;
|
||
// for(j = 0; j < 5-1; j++)//采样值由小到大排列
|
||
// {
|
||
// for(k = 0; k < 5-j-1; k++)
|
||
// {
|
||
// if(adc1_i[k] > adc1_i[k+1])
|
||
// {
|
||
// tem = adc1_i[k];
|
||
// adc1_i[k] = adc1_i[k+1];
|
||
// adc1_i[k+1] = tem;
|
||
// }
|
||
// }
|
||
// }
|
||
// for(uint8_t i = 1; i < 5 - 1; i++)
|
||
// {
|
||
// curadc0 = curadc0 + adc1_i[i];
|
||
// }
|
||
// curadc0 = curadc0 /((float)(5 - 2));//去掉一个最大值和一个最小值求平均值
|
||
// g_ptz.electric_current = curadc0;
|
||
// memset(adc1_i,0,sizeof(adc1_i));
|
||
// // pdebug(DEBUG_LEVEL_INFO,"get ptz Electric_Current: %.3fA",g_ptz.electric_current);
|
||
// }
|
||
|
||
// }
|
||
|
||
// //温度采集
|
||
// static void ptz_temperature_collect_tmp75_task()
|
||
// {
|
||
// static float tmp75[5];
|
||
// static unsigned char tmp75_num;
|
||
// float curtmp75;
|
||
// float tem;
|
||
// int j,k;
|
||
// tmp75[tmp75_num] = tmp75_read_temp();
|
||
// tmp75_num ++;
|
||
// if(tmp75_num >= 5)
|
||
// {
|
||
// tmp75_num = 0;
|
||
// for(j = 0; j < 5-1; j++)//采样值由小到大排列
|
||
// {
|
||
// for(k = 0; k < 5-j-1; k++)
|
||
// {
|
||
// if(tmp75[k] > tmp75[k+1])
|
||
// {
|
||
// tem = tmp75[k];
|
||
// tmp75[k] = tmp75[k+1];
|
||
// tmp75[k+1] = tem;
|
||
// }
|
||
// }
|
||
// }
|
||
// for(uint8_t i = 1; i < 5 - 1; i++)
|
||
// {
|
||
// curtmp75 = curtmp75 + tmp75[i];//去掉一个最大值和一个最小值
|
||
// }
|
||
// curtmp75 = curtmp75 / ((float)(5 - 2));
|
||
// g_ptz.temperature = curtmp75;
|
||
// memset(tmp75,0,sizeof(tmp75));
|
||
// // pdebug(DEBUG_LEVEL_INFO,"get ptz Temperature: %.3f℃",g_ptz.temperature);
|
||
// }
|
||
|
||
// }
|
||
|
||
//int counter;
|
||
//采集任务
|
||
static char ptz_data_collect_task()
|
||
{
|
||
int i=0,j=0;
|
||
while(1)
|
||
{
|
||
|
||
|
||
|
||
if(g_ptz.hori_start_stop_set == PTZ_HORI_START)
|
||
{//电机处于启动状态
|
||
// H_ADC2_Phase_current();
|
||
}
|
||
if(g_ptz.vert_start_stop_set == PTZ_VERT_START)
|
||
{//电机处于启动状态
|
||
// V_ADC0_Phase_current();
|
||
}
|
||
|
||
if(j >= 100)
|
||
{
|
||
j=0;
|
||
//云台不自检关闭，打开采集任务
|
||
#ifndef PTZ_NO_SELF_CHECK
|
||
ptz_Voltage_collect_adc1_task();
|
||
#endif
|
||
OSTimeDlyHMSM(0u, 0u, 0u, 2u);
|
||
g_ptz.electric_current = ptz_Current_collect_adc1_task();
|
||
// ptz_Current_collect_adc1_task();
|
||
// OSTimeDlyHMSM(0u, 0u, 0u, 50u);
|
||
}
|
||
|
||
if(i >= 3000)
|
||
{//降低温度采集频率
|
||
g_ptz.temperature = ptz_temperature_collect_tmp75_task();
|
||
|
||
//驱动电路温度采集
|
||
// Ntc_value();
|
||
i=0;
|
||
}
|
||
|
||
OSTimeDlyHMSM(0u, 0u, 0u, 1u);
|
||
|
||
i++;
|
||
j++;
|
||
}
|
||
}
|
||
|
||
|
||
|
||
|
||
static OS_STK task_data_collect_stk[TASK_PTZ_DATA_COLLECT_STK_SIZE];
|
||
static void creat_task_data_collect(void)
|
||
{
|
||
CPU_INT08U task_err;
|
||
CPU_INT08U name_err;
|
||
|
||
task_err = OSTaskCreateExt((void (*)(void *)) ptz_data_collect_task,
|
||
(void *) 0,
|
||
(OS_STK *)&task_data_collect_stk[TASK_PTZ_DATA_COLLECT_STK_SIZE - 1],
|
||
(INT8U ) TASK_PTZ_DATA_COLLECT_PRIO,
|
||
(INT16U ) TASK_PTZ_DATA_COLLECT_PRIO,
|
||
(OS_STK *)&task_data_collect_stk[0],
|
||
(INT32U ) TASK_PTZ_DATA_COLLECT_STK_SIZE,
|
||
(void *) 0,
|
||
(INT16U )(OS_TASK_OPT_STK_CHK | OS_TASK_OPT_STK_CLR));
|
||
#if (OS_TASK_NAME_EN > 0)
|
||
OSTaskNameSet(TASK_PTZ_DATA_COLLECT_PRIO, "ptz_data_collect_task", &name_err);
|
||
#endif
|
||
if ((task_err == OS_ERR_NONE) && (name_err == OS_ERR_NONE)) {
|
||
pdebug(DEBUG_LEVEL_INFO,"create ptz_data_collect_task success\r\n");
|
||
} else {
|
||
pdebug(DEBUG_LEVEL_FATAL,"create ptz_data_collect_task failed\r\n");
|
||
}
|
||
}
|
||
|
||
|
||
void init_data_collect_module(void)
|
||
{
|
||
//#ifndef PTZ_NO_SELF_CHECK
|
||
// ADC1_Init();//AD采集引脚初始化
|
||
i2c_init();
|
||
adc_init();
|
||
//#endif
|
||
// ADC2_Init();//AD采集引脚初始化
|
||
// ADC0_Init();//AD采集引脚初始化
|
||
|
||
// temp75_gpio_init();//温度传感器初始化
|
||
creat_task_data_collect();
|
||
}
|
||
|