Files
kunlun/ftm/mp/zero_cross_detec.c
2024-09-28 14:24:04 +08:00

122 lines
2.9 KiB
C
Executable File

/* os shim includes */
#include "os_utils.h"
#include "os_mem.h"
#include "chip_reg_base.h"
#include "hw_reg_api.h"
#include "mac_sys_reg.h"
#include "iot_io.h"
#include "iot_config.h"
#include "iot_errno_api.h"
#include "iot_config_api.h"
#include "iot_gpio_api.h"
#include "iot_board_api.h"
#include "iot_pt_func.h"
int iot_zc_buf_full(void *zc_buf_len)
{
uint8_t *len = (uint8_t *)zc_buf_len;
return *len >= IOT_ZC_BUF;
}
uint8_t iot_zc_circuit_check_status_get(uint8_t phase_zc, \
zc_circuit_check_status_t *zc_inform)
{
uint32_t tmp = 0;
uint8_t gpio_num;
uint8_t status = true;
uint8_t success=0,fail=0;
uint8_t timeout = 0;
zc_circuit_check_status_t *zc_inform_t = zc_inform;
gpio_num = iot_board_get_gpio(phase_zc);
if (GPIO_NO_VALID == gpio_num) {
iot_printf("error: invalid gpio to get.\n");
return ERR_FAIL;
}
/* wait 11 zc cycles */
timeout = iot_wait_timeout_fun2(iot_zc_buf_full, \
&zc_inform_t->zc_buf_len, true, 220);
/* disabel interrupt */
iot_gpio_interrupt_enable(gpio_num, 0);
iot_gpio_close(gpio_num);
/* get zc buf false */
if (timeout == ERR_TIMEOVER) {
return false;
}
for (int i = 1; i < IOT_ZC_BUF; i++) {
tmp = zc_inform_t->zc_buf[i] - zc_inform_t->zc_buf[i-1];
if ((tmp > IOT_ZC_FULL_PERIOD - IOT_ZC_FULL_OFFSET) \
&& (IOT_ZC_FULL_PERIOD + IOT_ZC_FULL_OFFSET > tmp)) {
success++;
} else {
fail++;
}
}
if (success < fail) {
status = false;
} else {
status = true;
}
zc_inform_t->status = status;
return status;
}
void iot_zc_int_process(int gpio_num)
{
zc_circuit_check_status_t *zc_inform = \
(zc_circuit_check_status_t *)(&iot_pt_ctxt.zc_circuit_check_status);
uint8_t count = zc_inform->zc_buf_len;
if(count < IOT_ZC_BUF) {
zc_inform->zc_buf[count] = \
RGF_MAC_READ_REG(CFG_RD_NTB_ADDR);
zc_inform->zc_buf_len++;
}
return;
}
uint32_t iot_zc_circuit_interrupt_init(uint8_t phase_zc)
{
int r=0;
uint8_t gpio_num;
uint32_t ret = ERR_OK;
gpio_num = iot_board_get_gpio(phase_zc);
iot_printf("pt zc gpio num: %d.\n", gpio_num);
if (GPIO_NO_VALID == gpio_num) {
iot_printf("error: invalid gpio to get.\n");
return ERR_FAIL;
}
r |= iot_gpio_open_as_interrupt(gpio_num);
iot_gpio_set_pull_mode(gpio_num, GPIO_PULL_UP);
r |= iot_gpio_interrupt_config
(gpio_num, GPIO_INT_EDGE_RAISING, (iot_gpio_isr_func)iot_zc_int_process,
gpio_num, GPIO_INT_FUNC_DISABLE_AUTOSTOP);
r |= iot_gpio_interrupt_enable(gpio_num, 1);
if (r != 0) {
ret = ERR_FAIL;
/* disabel interrupt */
iot_gpio_interrupt_enable(gpio_num, 0);
iot_gpio_close(gpio_num);
iot_printf("zc initial configure failed!\n");
} else {
iot_printf("zc initial configure successfully!\n");
}
return ret;
}