初始化仓库
This commit is contained in:
217
libraries/zf_device/zf_device_dl1b.c
Normal file
217
libraries/zf_device/zf_device_dl1b.c
Normal file
@@ -0,0 +1,217 @@
|
||||
/*********************************************************************************************************************
|
||||
* TC264 Opensourec Library <20><><EFBFBD><EFBFBD>TC264 <20><>Դ<EFBFBD>⣩<EFBFBD><E2A3A9>һ<EFBFBD><D2BB><EFBFBD><EFBFBD><EFBFBD>ڹٷ<DAB9> SDK <20>ӿڵĵ<DAB5><C4B5><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Դ<EFBFBD><D4B4>
|
||||
* Copyright (c) 2022 SEEKFREE <20><><EFBFBD>ɿƼ<C9BF>
|
||||
*
|
||||
* <20><><EFBFBD>ļ<EFBFBD><C4BC><EFBFBD> TC264 <20><>Դ<EFBFBD><D4B4><EFBFBD><EFBFBD>һ<EFBFBD><D2BB><EFBFBD><EFBFBD>
|
||||
*
|
||||
* TC264 <20><>Դ<EFBFBD><D4B4> <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
* <20><><EFBFBD><EFBFBD><EFBFBD>Ը<EFBFBD><D4B8><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ᷢ<EFBFBD><E1B7A2><EFBFBD><EFBFBD> GPL<50><4C>GNU General Public License<73><65><EFBFBD><EFBFBD> GNUͨ<55>ù<EFBFBD><C3B9><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>֤<EFBFBD><D6A4><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
* <20><> GPL <20>ĵ<EFBFBD>3<EFBFBD>棨<EFBFBD><E6A3A8> GPL3.0<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ѡ<EFBFBD><EFBFBD><EFBFBD>ģ<EFBFBD><EFBFBD>κκ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>İ汾<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>·<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>/<2F><><EFBFBD><EFBFBD><DEB8><EFBFBD>
|
||||
*
|
||||
* <20><><EFBFBD><EFBFBD>Դ<EFBFBD><D4B4><EFBFBD>ķ<EFBFBD><C4B7><EFBFBD><EFBFBD><EFBFBD>ϣ<EFBFBD><CFA3><EFBFBD><EFBFBD><EFBFBD>ܷ<EFBFBD><DCB7><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ã<EFBFBD><C3A3><EFBFBD><EFBFBD><EFBFBD>δ<EFBFBD><CEB4><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>κεı<CEB5>֤
|
||||
* <20><><EFBFBD><EFBFBD>û<EFBFBD><C3BB><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ի<EFBFBD><D4BB>ʺ<EFBFBD><CABA>ض<EFBFBD><D8B6><EFBFBD>;<EFBFBD>ı<EFBFBD>֤
|
||||
* <20><><EFBFBD><EFBFBD>ϸ<EFBFBD><CFB8><EFBFBD><EFBFBD><EFBFBD>μ<EFBFBD> GPL
|
||||
*
|
||||
* <20><>Ӧ<EFBFBD><D3A6><EFBFBD><EFBFBD><EFBFBD>յ<EFBFBD><D5B5><EFBFBD><EFBFBD><EFBFBD>Դ<EFBFBD><D4B4><EFBFBD><EFBFBD>ͬʱ<CDAC>յ<EFBFBD>һ<EFBFBD><D2BB> GPL <20>ĸ<EFBFBD><C4B8><EFBFBD>
|
||||
* <20><><EFBFBD><EFBFBD>û<EFBFBD>У<EFBFBD><D0A3><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><https://www.gnu.org/licenses/>
|
||||
*
|
||||
* <20><><EFBFBD><EFBFBD>ע<EFBFBD><D7A2><EFBFBD><EFBFBD>
|
||||
* <20><><EFBFBD><EFBFBD>Դ<EFBFBD><D4B4>ʹ<EFBFBD><CAB9> GPL3.0 <20><>Դ<EFBFBD><D4B4><EFBFBD><EFBFBD>֤Э<D6A4><D0AD> <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ϊ<EFBFBD><CEAA><EFBFBD>İ汾
|
||||
* <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ӣ<EFBFBD>İ<EFBFBD><C4B0><EFBFBD> libraries/doc <20>ļ<EFBFBD><C4BC><EFBFBD><EFBFBD>µ<EFBFBD> GPL3_permission_statement.txt <20>ļ<EFBFBD><C4BC><EFBFBD>
|
||||
* <20><><EFBFBD><EFBFBD>֤<EFBFBD><D6A4><EFBFBD><EFBFBD><EFBFBD><EFBFBD> libraries <20>ļ<EFBFBD><C4BC><EFBFBD><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD><EFBFBD>ļ<EFBFBD><C4BC><EFBFBD><EFBFBD>µ<EFBFBD> LICENSE <20>ļ<EFBFBD>
|
||||
* <20><>ӭ<EFBFBD><D3AD>λʹ<CEBB>ò<EFBFBD><C3B2><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD><DEB8><EFBFBD><EFBFBD><EFBFBD>ʱ<EFBFBD><CAB1><EFBFBD>뱣<EFBFBD><EBB1A3><EFBFBD><EFBFBD><EFBFBD>ɿƼ<C9BF><C6BC>İ<EFBFBD>Ȩ<EFBFBD><C8A8><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
*
|
||||
* <20>ļ<EFBFBD><C4BC><EFBFBD><EFBFBD><EFBFBD> zf_device_dl1b
|
||||
* <20><>˾<EFBFBD><CBBE><EFBFBD><EFBFBD> <20>ɶ<EFBFBD><C9B6><EFBFBD><EFBFBD>ɿƼ<C9BF><C6BC><EFBFBD><EFBFBD><EFBFBD>˾
|
||||
* <20>汾<EFBFBD><E6B1BE>Ϣ <20>鿴 libraries/doc <20>ļ<EFBFBD><C4BC><EFBFBD><EFBFBD><EFBFBD> version <20>ļ<EFBFBD> <20>汾˵<E6B1BE><CBB5>
|
||||
* <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> ADS v1.10.2
|
||||
* <20><><EFBFBD><EFBFBD>ƽ̨ TC264D
|
||||
* <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> https://seekfree.taobao.com/
|
||||
*
|
||||
* <20>ļ<DEB8>¼
|
||||
* <20><><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD> <20><>ע
|
||||
* 2022-09-15 pudding first version
|
||||
********************************************************************************************************************/
|
||||
/*********************************************************************************************************************
|
||||
* <20><><EFBFBD>߶<EFBFBD><DFB6>壺
|
||||
* ------------------------------------
|
||||
* ģ<><C4A3><EFBFBD>ܽ<EFBFBD> <20><>Ƭ<EFBFBD><C6AC><EFBFBD>ܽ<EFBFBD>
|
||||
* SCL <20>鿴 zf_device_dl1b.h <20><> DL1B_SCL_PIN <20>궨<EFBFBD><EAB6A8>
|
||||
* SDA <20>鿴 zf_device_dl1b.h <20><> DL1B_SDA_PIN <20>궨<EFBFBD><EAB6A8>
|
||||
* XS <20>鿴 zf_device_dl1b.h <20><> DL1B_XS_PIN <20>궨<EFBFBD><EAB6A8>
|
||||
* VCC 5V <20><>Դ
|
||||
* GND <20><>Դ<EFBFBD><D4B4>
|
||||
* ------------------------------------
|
||||
********************************************************************************************************************/
|
||||
|
||||
#include "zf_common_debug.h"
|
||||
|
||||
#include "zf_driver_delay.h"
|
||||
#include "zf_driver_exti.h"
|
||||
#include "zf_driver_soft_iic.h"
|
||||
|
||||
#include "zf_device_dl1b.h"
|
||||
#include "zf_device_config.h"
|
||||
#include "zf_device_type.h"
|
||||
|
||||
uint8 dl1b_init_flag = 0;
|
||||
uint8 dl1b_finsh_flag = 0;
|
||||
uint16 dl1b_distance_mm = 8192;
|
||||
|
||||
#if DL1B_USE_SOFT_IIC
|
||||
static soft_iic_info_struct dl1b_iic_struct;
|
||||
|
||||
#define dl1b_transfer_8bit_array(tdata, tlen, rdata, rlen) (soft_iic_transfer_8bit_array(&dl1b_iic_struct, (tdata), (tlen), (rdata), (rlen)))
|
||||
#else
|
||||
#error "<22>ݲ<EFBFBD>֧<EFBFBD><D6A7>Ӳ<EFBFBD><D3B2>IICͨѶ"
|
||||
#endif
|
||||
|
||||
//-------------------------------------------------------------------------------------------------------------------
|
||||
// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD><EFBFBD>Ժ<EFBFBD><D4BA><EFBFBD>Ϊ<EFBFBD><CEAA>λ<EFBFBD>ķ<EFBFBD>Χ<EFBFBD><CEA7><EFBFBD><EFBFBD>
|
||||
// <20><><EFBFBD><EFBFBD>˵<EFBFBD><CBB5> void
|
||||
// <20><><EFBFBD>ز<EFBFBD><D8B2><EFBFBD> void
|
||||
// ʹ<><CAB9>ʾ<EFBFBD><CABE> dl1b_get_distance();
|
||||
// <20><>ע<EFBFBD><D7A2>Ϣ <20>ڿ<EFBFBD>ʼ<EFBFBD><CABC><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>̲<EFBFBD><CCB2><EFBFBD><EFBFBD><EFBFBD>Ҳ<EFBFBD><D2B2><EFBFBD>ô˺<C3B4><CBBA><EFBFBD>
|
||||
//-------------------------------------------------------------------------------------------------------------------
|
||||
void dl1b_get_distance (void)
|
||||
{
|
||||
if(dl1b_init_flag)
|
||||
{
|
||||
uint8 data_buffer[3] = {0};
|
||||
int16 dl1b_distance_temp = 0;
|
||||
|
||||
data_buffer[0] = DL1B_GPIO__TIO_HV_STATUS >> 8;
|
||||
data_buffer[1] = DL1B_GPIO__TIO_HV_STATUS & 0xFF;
|
||||
dl1b_transfer_8bit_array(data_buffer, 2, &data_buffer[2], 1);
|
||||
|
||||
if(data_buffer[2])
|
||||
{
|
||||
|
||||
data_buffer[0] = DL1B_SYSTEM__INTERRUPT_CLEAR >> 8;
|
||||
data_buffer[1] = DL1B_SYSTEM__INTERRUPT_CLEAR & 0xFF;
|
||||
data_buffer[2] = 0x01;
|
||||
dl1b_transfer_8bit_array(data_buffer, 3, data_buffer, 0);// clear Interrupt
|
||||
|
||||
data_buffer[0] = DL1B_RESULT__RANGE_STATUS >> 8;
|
||||
data_buffer[1] = DL1B_RESULT__RANGE_STATUS & 0xFF;
|
||||
dl1b_transfer_8bit_array(data_buffer, 2, &data_buffer[2], 1);
|
||||
|
||||
if(0x89 == data_buffer[2])
|
||||
{
|
||||
data_buffer[0] = DL1B_RESULT__FINAL_CROSSTALK_CORRECTED_RANGE_MM_SD0 >> 8;
|
||||
data_buffer[1] = DL1B_RESULT__FINAL_CROSSTALK_CORRECTED_RANGE_MM_SD0 & 0xFF;
|
||||
dl1b_transfer_8bit_array(data_buffer, 2, data_buffer, 2);
|
||||
dl1b_distance_temp = data_buffer[0];
|
||||
dl1b_distance_temp = (dl1b_distance_temp << 8) | data_buffer[1];
|
||||
|
||||
if(dl1b_distance_temp > 4000 || dl1b_distance_temp < 0)
|
||||
{
|
||||
dl1b_distance_mm = 8192;
|
||||
dl1b_finsh_flag = 0;
|
||||
}
|
||||
else
|
||||
{
|
||||
dl1b_distance_mm = dl1b_distance_temp;
|
||||
dl1b_finsh_flag = 1;
|
||||
}
|
||||
}
|
||||
else
|
||||
{
|
||||
dl1b_distance_mm = 8192;
|
||||
dl1b_finsh_flag = 0;
|
||||
}
|
||||
}
|
||||
else
|
||||
{
|
||||
dl1b_distance_mm = 8192;
|
||||
dl1b_finsh_flag = 0;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
//-------------------------------------------------------------------------------------------------------------------
|
||||
// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> DL1B INT <20>ж<EFBFBD><D0B6><EFBFBD>Ӧ<EFBFBD><D3A6><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
// <20><><EFBFBD><EFBFBD>˵<EFBFBD><CBB5> void
|
||||
// <20><><EFBFBD>ز<EFBFBD><D8B2><EFBFBD> void
|
||||
// ʹ<><CAB9>ʾ<EFBFBD><CABE> dl1b_int_handler();
|
||||
// <20><>ע<EFBFBD><D7A2>Ϣ <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ҫ<EFBFBD><D2AA> DL1B_INT_PIN <20><>Ӧ<EFBFBD><D3A6><EFBFBD>ⲿ<EFBFBD>жϴ<D0B6><CFB4><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>е<EFBFBD><D0B5><EFBFBD>
|
||||
//-------------------------------------------------------------------------------------------------------------------
|
||||
void dl1b_int_handler (void)
|
||||
{
|
||||
#if DL1B_INT_ENABLE
|
||||
dl1b_get_distance();
|
||||
#endif
|
||||
}
|
||||
|
||||
//-------------------------------------------------------------------------------------------------------------------
|
||||
// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20><>ʼ<EFBFBD><CABC> DL1B
|
||||
// <20><><EFBFBD><EFBFBD>˵<EFBFBD><CBB5> void
|
||||
// <20><><EFBFBD>ز<EFBFBD><D8B2><EFBFBD> uint8 1-<2D><>ʼ<EFBFBD><CABC>ʧ<EFBFBD><CAA7> 0-<2D><>ʼ<EFBFBD><CABC><EFBFBD>ɹ<EFBFBD>
|
||||
// ʹ<><CAB9>ʾ<EFBFBD><CABE> dl1b_init();
|
||||
// <20><>ע<EFBFBD><D7A2>Ϣ
|
||||
//-------------------------------------------------------------------------------------------------------------------
|
||||
uint8 dl1b_init (void)
|
||||
{
|
||||
uint8 return_state = 0;
|
||||
uint8 data_buffer[2 + sizeof(dl1b_config_file)];
|
||||
uint16 time_out_count = 0;
|
||||
|
||||
#if DL1B_USE_SOFT_IIC
|
||||
soft_iic_init(&dl1b_iic_struct, DL1B_DEV_ADDR, DL1B_SOFT_IIC_DELAY, DL1B_SCL_PIN, DL1B_SDA_PIN);
|
||||
#else
|
||||
iic_init(DL1B_IIC, DL1B_DEV_ADDR, DL1B_IIC_SPEED, DL1B_SCL_PIN, DL1B_SDA_PIN);
|
||||
#endif
|
||||
gpio_init(DL1B_XS_PIN, GPO, GPIO_HIGH, GPO_PUSH_PULL);
|
||||
|
||||
do
|
||||
{
|
||||
system_delay_ms(50);
|
||||
gpio_low(DL1B_XS_PIN);
|
||||
system_delay_ms(10);
|
||||
gpio_high(DL1B_XS_PIN);
|
||||
system_delay_ms(50);
|
||||
|
||||
data_buffer[0] = DL1B_FIRMWARE__SYSTEM_STATUS >> 8;
|
||||
data_buffer[1] = DL1B_FIRMWARE__SYSTEM_STATUS & 0xFF;
|
||||
dl1b_transfer_8bit_array(data_buffer, 2, &data_buffer[2], 1);
|
||||
return_state = (0x01 == (data_buffer[2] & 0x01)) ? (0) : (1);
|
||||
if(1 == return_state)
|
||||
{
|
||||
break;
|
||||
}
|
||||
|
||||
data_buffer[0] = DL1B_I2C_SLAVE__DEVICE_ADDRESS >> 8;
|
||||
data_buffer[1] = DL1B_I2C_SLAVE__DEVICE_ADDRESS & 0xFF;
|
||||
memcpy(&data_buffer[2], (uint8 *)dl1b_config_file, sizeof(dl1b_config_file));
|
||||
dl1b_transfer_8bit_array(data_buffer, 2 + sizeof(dl1b_config_file), data_buffer, 0);
|
||||
|
||||
while(1)
|
||||
{
|
||||
data_buffer[0] = DL1B_GPIO__TIO_HV_STATUS >> 8;
|
||||
data_buffer[1] = DL1B_GPIO__TIO_HV_STATUS & 0xFF;
|
||||
dl1b_transfer_8bit_array(data_buffer, 2, &data_buffer[2], 1);
|
||||
if(0x00 == (data_buffer[2] & 0x01))
|
||||
{
|
||||
time_out_count = 0;
|
||||
break;
|
||||
}
|
||||
if(DL1B_TIMEOUT_COUNT < time_out_count ++)
|
||||
{
|
||||
return_state = 1;
|
||||
break;
|
||||
}
|
||||
system_delay_ms(1);
|
||||
}
|
||||
|
||||
dl1b_init_flag = 1;
|
||||
}while(0);
|
||||
|
||||
#if DL1B_INT_ENABLE
|
||||
exti_init(DL1B_INT_PIN, EXTI_TRIGGER_FALLING);
|
||||
dl1b_int_handler();
|
||||
dl1b_finsh_flag = 0;
|
||||
#endif
|
||||
set_tof_type(TOF_DL1B, dl1b_int_handler);
|
||||
|
||||
return return_state;
|
||||
}
|
||||
Reference in New Issue
Block a user