/********************************************************************************************************************* * TC264 Opensourec Library 即（TC264 开源库）是一个基于官方 SDK 接口的第三方开源库 * Copyright (c) 2022 SEEKFREE 逐飞科技 * * 本文件是 TC264 开源库的一部分 * * TC264 开源库 是免费软件 * 您可以根据自由软件基金会发布的 GPL（GNU General Public License，即 GNU通用公共许可证）的条款 * 即 GPL 的第3版（即 GPL3.0）或（您选择的）任何后来的版本，重新发布和/或修改它 * * 本开源库的发布是希望它能发挥作用，但并未对其作任何的保证 * 甚至没有隐含的适销性或适合特定用途的保证 * 更多细节请参见 GPL * * 您应该在收到本开源库的同时收到一份 GPL 的副本 * 如果没有，请参阅 * * 额外注明： * 本开源库使用 GPL3.0 开源许可证协议 以上许可申明为译文版本 * 许可申明英文版在 libraries/doc 文件夹下的 GPL3_permission_statement.txt 文件中 * 许可证副本在 libraries 文件夹下 即该文件夹下的 LICENSE 文件 * 欢迎各位使用并传播本程序 但修改内容时必须保留逐飞科技的版权声明（即本声明） * * 文件名称 zf_driver_encoder * 公司名称 成都逐飞科技有限公司 * 版本信息 查看 libraries/doc 文件夹内 version 文件 版本说明 * 开发环境 ADS v1.10.2 * 适用平台 TC264D * 店铺链接 https://seekfree.taobao.com/ * * 修改记录 * 日期 作者 备注 * 2022-09-15 pudding first version ********************************************************************************************************************/ #include "IfxGpt12_IncrEnc.h" #include "zf_common_debug.h" #include "zf_driver_encoder.h" static uint8 encoder_mode[TIM6_ENCODER + 1] = {0}; //------------------------------------------------------------------------------------------------------------------- // 函数简介 编码器地址设置 内部调用 // 参数说明 gptn 选择所使用的GPT12定时器 // 参数说明 count_pin 设置计数引脚 // 参数说明 dir_pin 设置计数方向引脚 // 返回参数 void // 使用示例 encoder_mapping_set(gptn, ch1_pin, ch2_pin); // 备注信息 //------------------------------------------------------------------------------------------------------------------- static void encoder_mapping_set (encoder_index_enum encoder_n, encoder_channel1_enum ch1_pin, encoder_channel2_enum ch2_pin) { IfxGpt12_TxIn_In *ch1; IfxGpt12_TxEud_In *ch2; switch(encoder_n) { case TIM2_ENCODER: { if (TIM2_ENCODER_CH1_P00_7 == ch1_pin) ch1 = &IfxGpt120_T2INA_P00_7_IN; else if (TIM2_ENCODER_CH1_P33_7 == ch1_pin) ch1 = &IfxGpt120_T2INB_P33_7_IN; else zf_assert(FALSE); if (TIM2_ENCODER_CH2_P00_8 == ch2_pin) ch2 = &IfxGpt120_T2EUDA_P00_8_IN; else if (TIM2_ENCODER_CH2_P33_6 == ch2_pin) ch2 = &IfxGpt120_T2EUDB_P33_6_IN; else zf_assert(FALSE); }break; case TIM3_ENCODER: { if (TIM3_ENCODER_CH1_P02_6 == ch1_pin) ch1 = &IfxGpt120_T3INA_P02_6_IN; else zf_assert(FALSE); if (TIM3_ENCODER_CH2_P02_7 == ch2_pin) ch2 = &IfxGpt120_T3EUDA_P02_7_IN; else zf_assert(FALSE); }break; case TIM4_ENCODER: { if (TIM4_ENCODER_CH1_P02_8 == ch1_pin) ch1 = &IfxGpt120_T4INA_P02_8_IN; else zf_assert(FALSE); if (TIM4_ENCODER_CH2_P00_9 == ch2_pin) ch2 = &IfxGpt120_T4EUDA_P00_9_IN; else if (TIM4_ENCODER_CH2_P33_5 == ch2_pin) ch2 = &IfxGpt120_T4EUDB_P33_5_IN; else zf_assert(FALSE); }break; case TIM5_ENCODER: { if (TIM5_ENCODER_CH1_P21_7 == ch1_pin) ch1 = &IfxGpt120_T5INA_P21_7_IN; else if (TIM5_ENCODER_CH1_P10_3 == ch1_pin) ch1 = &IfxGpt120_T5INB_P10_3_IN; else zf_assert(FALSE); if (TIM5_ENCODER_CH2_P21_6 == ch2_pin) ch2 = &IfxGpt120_T5EUDA_P21_6_IN; else if (TIM5_ENCODER_CH2_P10_1 == ch2_pin) ch2 = &IfxGpt120_T5EUDB_P10_1_IN; else zf_assert(FALSE); }break; case TIM6_ENCODER: { if (TIM6_ENCODER_CH1_P20_3 == ch1_pin) ch1 = &IfxGpt120_T6INA_P20_3_IN; else if (TIM6_ENCODER_CH1_P10_2 == ch1_pin) ch1 = &IfxGpt120_T6INB_P10_2_IN; else zf_assert(FALSE); if (TIM6_ENCODER_CH2_P20_0 == ch2_pin) ch2 = &IfxGpt120_T6EUDA_P20_0_IN; else zf_assert(FALSE); }break; } #pragma warning 507 IfxGpt12_initTxInPinWithPadLevel(ch1, IfxPort_InputMode_pullUp, IfxPort_PadDriver_cmosAutomotiveSpeed1); IfxGpt12_initTxEudInPinWithPadLevel(ch2, IfxPort_InputMode_pullUp, IfxPort_PadDriver_cmosAutomotiveSpeed1); #pragma warning default } //------------------------------------------------------------------------------------------------------------------- // 函数简介 编码器数据采集 // 参数说明 gptn 选择所使用的定时器 // 返回参数 void // 使用示例 int16 speed; speed = encoder_get_count(TIM2_ENCODER); // 使用T2定时器 // 备注信息 //------------------------------------------------------------------------------------------------------------------- int16 encoder_get_count (encoder_index_enum encoder_n) { int16 encoder_data = 0; switch(encoder_n) { case TIM2_ENCODER: encoder_data = (int16)IfxGpt12_T2_getTimerValue(&MODULE_GPT120); break; case TIM3_ENCODER: encoder_data = (int16)IfxGpt12_T3_getTimerValue(&MODULE_GPT120); break; case TIM4_ENCODER: encoder_data = (int16)IfxGpt12_T4_getTimerValue(&MODULE_GPT120); break; case TIM5_ENCODER: encoder_data = (int16)IfxGpt12_T5_getTimerValue(&MODULE_GPT120); break; case TIM6_ENCODER: encoder_data = (int16)IfxGpt12_T6_getTimerValue(&MODULE_GPT120); break; default: encoder_data = 0; } if(0 == encoder_mode[encoder_n]) { encoder_data = encoder_data / 4; } return encoder_data; } //------------------------------------------------------------------------------------------------------------------- // 函数简介 编码器计数清除 // 参数说明 gptn 选择所使用的定时器 // 返回参数 void // 使用示例 encoder_clear_count(TIM2_ENCODER);// 使用T2定时器 // 备注信息 //------------------------------------------------------------------------------------------------------------------- void encoder_clear_count (encoder_index_enum encoder_n) { switch(encoder_n) { case TIM2_ENCODER: IfxGpt12_T2_setTimerValue(&MODULE_GPT120, 0); break; case TIM3_ENCODER: IfxGpt12_T3_setTimerValue(&MODULE_GPT120, 0); break; case TIM4_ENCODER: IfxGpt12_T4_setTimerValue(&MODULE_GPT120, 0); break; case TIM5_ENCODER: IfxGpt12_T5_setTimerValue(&MODULE_GPT120, 0); break; case TIM6_ENCODER: IfxGpt12_T6_setTimerValue(&MODULE_GPT120, 0); break; } } //------------------------------------------------------------------------------------------------------------------- // 函数简介 正交编码器采集初始化 // 参数说明 encoder_n 选择所使用的GPT12定时器 // 参数说明 ch1_pin ENCODER 通道 1 // 参数说明 ch2_pin ENCODER 通道 2 // 返回参数 void // 使用示例 encoder_quad_init(TIM2_ENCODER, TIM2_ENCODER_CH1_P00_7, TIM2_ENCODER_CH2_P00_8);// 使用T2定时器 P00_7引脚为A通道 P00_8引脚为B通道 // 备注信息 //------------------------------------------------------------------------------------------------------------------- void encoder_quad_init (encoder_index_enum encoder_n, encoder_channel1_enum ch1_pin, encoder_channel2_enum ch2_pin) { // zf_assert(encoder_n <= TIM4_ENCODER); // 完全正交采集仅 TIM2 TIM3 TIM4支持 如果在这里报错 可以尝试使用下面的方向初始化encoder_dir_init IfxGpt12_enableModule(&MODULE_GPT120); IfxGpt12_setGpt1BlockPrescaler(&MODULE_GPT120, IfxGpt12_Gpt1BlockPrescaler_4); IfxGpt12_setGpt2BlockPrescaler(&MODULE_GPT120, IfxGpt12_Gpt2BlockPrescaler_4); encoder_mapping_set(encoder_n, ch1_pin, ch2_pin); switch(encoder_n) { case TIM2_ENCODER: { IfxGpt12_T2_setCounterInputMode(&MODULE_GPT120, IfxGpt12_IncrementalInterfaceInputMode_bothEdgesTxINOrTxEUD); IfxGpt12_T2_setDirectionSource (&MODULE_GPT120, IfxGpt12_TimerDirectionSource_external); IfxGpt12_T2_setMode (&MODULE_GPT120, IfxGpt12_Mode_incrementalInterfaceEdgeDetection); IfxGpt12_T2_run (&MODULE_GPT120, IfxGpt12_TimerRun_start); }break; case TIM3_ENCODER: { IfxGpt12_T3_setCounterInputMode(&MODULE_GPT120, IfxGpt12_IncrementalInterfaceInputMode_bothEdgesTxINOrTxEUD); IfxGpt12_T3_setDirectionSource (&MODULE_GPT120, IfxGpt12_TimerDirectionSource_external); IfxGpt12_T3_setMode (&MODULE_GPT120, IfxGpt12_Mode_incrementalInterfaceEdgeDetection); IfxGpt12_T3_run (&MODULE_GPT120, IfxGpt12_TimerRun_start); }break; case TIM4_ENCODER: { IfxGpt12_T4_setCounterInputMode(&MODULE_GPT120, IfxGpt12_IncrementalInterfaceInputMode_bothEdgesTxINOrTxEUD); IfxGpt12_T4_setDirectionSource (&MODULE_GPT120, IfxGpt12_TimerDirectionSource_external); IfxGpt12_T4_setMode (&MODULE_GPT120, IfxGpt12_Mode_incrementalInterfaceEdgeDetection); IfxGpt12_T4_run (&MODULE_GPT120, IfxGpt12_TimerRun_start); }break; case TIM5_ENCODER: { IfxGpt12_T5_setCounterInputMode(&MODULE_GPT120, IfxGpt12_IncrementalInterfaceInputMode_bothEdgesTxINOrTxEUD); IfxGpt12_T5_setDirectionSource (&MODULE_GPT120, IfxGpt12_TimerDirectionSource_external); IfxGpt12_T5_setMode (&MODULE_GPT120, IfxGpt12_Mode_incrementalInterfaceEdgeDetection); IfxGpt12_T5_run (&MODULE_GPT120, IfxGpt12_TimerRun_start); }break; case TIM6_ENCODER: { IfxGpt12_T6_setCounterInputMode(&MODULE_GPT120, IfxGpt12_IncrementalInterfaceInputMode_bothEdgesTxINOrTxEUD); IfxGpt12_T6_setDirectionSource (&MODULE_GPT120, IfxGpt12_TimerDirectionSource_external); IfxGpt12_T6_setMode (&MODULE_GPT120, IfxGpt12_Mode_incrementalInterfaceEdgeDetection); IfxGpt12_T6_run (&MODULE_GPT120, IfxGpt12_TimerRun_start); }break; } encoder_mode[encoder_n] = 0; } //------------------------------------------------------------------------------------------------------------------- // 函数简介 方向编码器采集初始化 // 参数说明 encoder_n 选择所使用的GPT12定时器 // 参数说明 ch1_pin 设置计数引脚 // 参数说明 ch2_pin 设置方向引脚 // 返回参数 void // 使用示例 encoder_quad_init(TIM2_ENCODER, TIM2_ENCODER_CH1_P00_7, TIM2_ENCODER_CH2_P00_8);// 使用T2定时器 P00_7引脚进行计数 计数方向使用P00_8引脚 // 备注信息 英飞凌系列单片机无需区分正交和方向编码器，此处仅保留接口方便用户使用 //------------------------------------------------------------------------------------------------------------------- void encoder_dir_init (encoder_index_enum encoder_n, encoder_channel1_enum count_pin, encoder_channel2_enum dir_pin) { IfxGpt12_enableModule(&MODULE_GPT120); IfxGpt12_setGpt1BlockPrescaler(&MODULE_GPT120, IfxGpt12_Gpt1BlockPrescaler_4); IfxGpt12_setGpt2BlockPrescaler(&MODULE_GPT120, IfxGpt12_Gpt2BlockPrescaler_4); encoder_mapping_set(encoder_n, count_pin, dir_pin); switch(encoder_n) { case TIM2_ENCODER: { IfxGpt12_T2_setCounterInputMode(&MODULE_GPT120, IfxGpt12_CounterInputMode_risingEdgeTxIN); IfxGpt12_T2_setDirectionSource (&MODULE_GPT120, IfxGpt12_TimerDirectionSource_external); IfxGpt12_T2_setMode (&MODULE_GPT120, IfxGpt12_Mode_counter); IfxGpt12_T2_run (&MODULE_GPT120, IfxGpt12_TimerRun_start); }break; case TIM3_ENCODER: { IfxGpt12_T3_setCounterInputMode(&MODULE_GPT120, IfxGpt12_CounterInputMode_risingEdgeTxIN); IfxGpt12_T3_setDirectionSource (&MODULE_GPT120, IfxGpt12_TimerDirectionSource_external); IfxGpt12_T3_setMode (&MODULE_GPT120, IfxGpt12_Mode_counter); IfxGpt12_T3_run (&MODULE_GPT120, IfxGpt12_TimerRun_start); }break; case TIM4_ENCODER: { IfxGpt12_T4_setCounterInputMode(&MODULE_GPT120, IfxGpt12_CounterInputMode_risingEdgeTxIN); IfxGpt12_T4_setDirectionSource (&MODULE_GPT120, IfxGpt12_TimerDirectionSource_external); IfxGpt12_T4_setMode (&MODULE_GPT120, IfxGpt12_Mode_counter); IfxGpt12_T4_run (&MODULE_GPT120, IfxGpt12_TimerRun_start); }break; case TIM5_ENCODER: { IfxGpt12_T5_setCounterInputMode(&MODULE_GPT120, IfxGpt12_CounterInputMode_risingEdgeTxIN); IfxGpt12_T5_setDirectionSource (&MODULE_GPT120, IfxGpt12_TimerDirectionSource_external); IfxGpt12_T5_setMode (&MODULE_GPT120, IfxGpt12_Mode_counter); IfxGpt12_T5_run (&MODULE_GPT120, IfxGpt12_TimerRun_start); }break; case TIM6_ENCODER: { IfxGpt12_T6_setCounterInputMode(&MODULE_GPT120, IfxGpt12_CounterInputMode_risingEdgeTxIN); IfxGpt12_T6_setDirectionSource (&MODULE_GPT120, IfxGpt12_TimerDirectionSource_external); IfxGpt12_T6_setMode (&MODULE_GPT120, IfxGpt12_Mode_counter); IfxGpt12_T6_run (&MODULE_GPT120, IfxGpt12_TimerRun_start); }break; } encoder_mode[encoder_n] = 1; }