feat(csi): added csi bridge share control code

This commit is contained in:
Armando
2024-01-09 16:15:52 +08:00
committed by Armando (Dou Yiwen)
parent 251239d59d
commit 8f097a4629
9 changed files with 272 additions and 2 deletions

View File

@ -45,6 +45,10 @@ if(NOT BOOTLOADER_BUILD)
list(APPEND srcs "adc_share_hw_ctrl.c")
endif()
if(CONFIG_SOC_ISP_SHARE_CSI_BRG)
list(APPEND srcs "mipi_csi_share_hw_ctrl.c")
endif()
if(CONFIG_SOC_PM_SUPPORT_CPU_PD)
list(APPEND srcs "sleep_cpu.c")
endif()

View File

@ -0,0 +1,46 @@
/*
* SPDX-FileCopyrightText: 2024 Espressif Systems (Shanghai) CO LTD
*
* SPDX-License-Identifier: Apache-2.0
*/
#pragma once
#include <stdint.h>
#include "esp_err.h"
#ifdef __cplusplus
extern "C" {
#endif
typedef enum {
MIPI_CSI_BRG_USER_CSI, ///< Used by CSI Host
MIPI_CSI_BRG_USER_ISP_DVP, ///< Used by ISP DVP
MIPI_CSI_BRG_USER_SHARE, ///< Don't care user, share the usage with other users
} mipi_csi_brg_user_t;
/**
* @brief Claim MIPI CSI Bridge peripheral
*
* @param[in] user CSI Bridge user
* @param[out] out_id ID of the CSI Bridge
*
* @return
* - ESP_OK
* - ESP_ERR_NOT_FOUND No free CSI Bridge
*/
esp_err_t mipi_csi_brg_claim(mipi_csi_brg_user_t user, int *out_id);
/**
* @brief Declaim MIPI CSI Bridge peripheral
*
* @param[in] id ID of the CSI Bridge
*
* @return
* - ESP_OK
* - ESP_ERR_INVALID_STATE CSI Bridge isn't claimed yet
*/
esp_err_t mipi_csi_brg_declaim(int id);
#ifdef __cplusplus
}
#endif

View File

@ -0,0 +1,88 @@
/*
* SPDX-FileCopyrightText: 2024 Espressif Systems (Shanghai) CO LTD
*
* SPDX-License-Identifier: Apache-2.0
*/
#include "sdkconfig.h"
#include "esp_log.h"
#include "freertos/FreeRTOS.h"
#include "esp_private/periph_ctrl.h"
#include "esp_private/mipi_csi_share_hw_ctrl.h"
#include "soc/soc_caps.h"
#include "hal/mipi_csi_ll.h"
#define MIPI_CSI_BRG_USER_NO_USER 99
typedef struct {
mipi_csi_brg_user_t user[MIPI_CSI_BRG_LL_BRG_NUMS];
int ref_cnt[MIPI_CSI_BRG_LL_BRG_NUMS];
portMUX_TYPE spinlock;
} csi_brg_share_ctx_t;
static csi_brg_share_ctx_t s_ctx = {
.user[0 ...(MIPI_CSI_BRG_LL_BRG_NUMS - 1)] = MIPI_CSI_BRG_USER_NO_USER,
.ref_cnt[0 ...(MIPI_CSI_BRG_LL_BRG_NUMS - 1)] = 0,
.spinlock = portMUX_INITIALIZER_UNLOCKED,
};
static const char *TAG = "CSI_SHARE";
esp_err_t mipi_csi_brg_claim(mipi_csi_brg_user_t user, int *out_id)
{
bool found = true;
portENTER_CRITICAL(&s_ctx.spinlock);
for (int i = 0; i < MIPI_CSI_BRG_LL_BRG_NUMS; i ++) {
bool user_is_shared = (s_ctx.user[i] == MIPI_CSI_BRG_USER_SHARE);
bool to_share = (user == MIPI_CSI_BRG_USER_SHARE);
bool duplicate_user = (s_ctx.user[i] == user);
if (s_ctx.ref_cnt[i] == 0) {
PERIPH_RCC_ATOMIC() {
mipi_csi_ll_enable_brg_module_clock(i, true);
mipi_csi_ll_reset_brg_module_clock(i);
}
s_ctx.user[i] = user;
} else {
if (!user_is_shared && !to_share && !duplicate_user) {
found = false;
}
if (user_is_shared) {
s_ctx.user[i] = user;
}
}
if (found) {
s_ctx.ref_cnt[i]++;
*out_id = i;
break;
}
}
portEXIT_CRITICAL(&s_ctx.spinlock);
if (!found) {
return ESP_ERR_NOT_FOUND;
}
return ESP_OK;
}
esp_err_t mipi_csi_brg_declaim(int id)
{
portENTER_CRITICAL(&s_ctx.spinlock);
s_ctx.ref_cnt[id]--;
if (s_ctx.ref_cnt[id] < 0) {
portEXIT_CRITICAL(&s_ctx.spinlock);
ESP_LOGE(TAG, "%s called, but s_ctx.ref_cnt[%d] == 0", __func__, id);
return ESP_ERR_INVALID_STATE;
} else if (s_ctx.ref_cnt[id] == 0) {
PERIPH_RCC_ATOMIC() {
mipi_csi_ll_enable_brg_module_clock(id, false);
}
s_ctx.user[id] = MIPI_CSI_BRG_USER_NO_USER;
}
portEXIT_CRITICAL(&s_ctx.spinlock);
return ESP_OK;
}

View File

@ -0,0 +1,70 @@
/*
* SPDX-FileCopyrightText: 2024 Espressif Systems (Shanghai) CO LTD
*
* SPDX-License-Identifier: Apache-2.0
*/
#pragma once
#include <stdbool.h>
#include <stdlib.h>
#include "hal/misc.h"
#include "hal/assert.h"
#include "hal/hal_utils.h"
#include "soc/mipi_csi_bridge_struct.h"
#ifdef __cplusplus
extern "C" {
#endif
#define MIPI_CSI_BRG_LL_BRG_NUMS 1
#define MIPI_CSI_BRG_LL_GET_HW(id) (((id) == 0) ? &MIPI_CSI_BRIDGE : NULL)
/**
* @brief Enable the CSI bridge
*
* @param dev Pointer to the CSI bridge controller register base address
* @param en True to enable, false to disable
*/
static inline void mipi_csi_brg_ll_enable(csi_brg_dev_t *dev, bool en)
{
dev->csi_en.csi_brg_en = en;
}
/**
* @brief Set the number of 64-bit words in one dma burst transfer
*
* @note valid only when csi_bridge is the flow controller
*
* @param dev Pointer to the CSI bridge controller register base address
* @param burst_len Number of 64-bit words in one dma burst transfer
*/
static inline void mipi_csi_brg_ll_set_burst_len(csi_brg_dev_t *dev, uint32_t burst_len)
{
dev->dma_req_cfg.dma_burst_len = burst_len;
}
/**
* @brief Set horizontal pixel number
*
* @param[in] dev Pointer to the CSI bridge controller register base address
* @param[in] pixel_num number of pixels
*/
static inline void mipi_csi_brg_ll_set_intput_data_h_pixel_num(csi_brg_dev_t *dev, uint32_t pixel_num)
{
dev->frame_cfg.hadr_num = pixel_num;
}
/**
* @brief Set vertical row number
*
* @param[in] dev Pointer to the CSI bridge controller register base address
* @param[in] row_num number of rows
*/
static inline void mipi_csi_brg_ll_set_intput_data_v_row_num(csi_brg_dev_t *dev, uint32_t row_num)
{
dev->frame_cfg.vadr_num = row_num;
}
#ifdef __cplusplus
}
#endif

View File

@ -0,0 +1,55 @@
/*
* SPDX-FileCopyrightText: 2024 Espressif Systems (Shanghai) CO LTD
*
* SPDX-License-Identifier: Apache-2.0
*/
#pragma once
#include <stdbool.h>
#include <stdlib.h>
#include "hal/misc.h"
#include "hal/assert.h"
#include "hal/hal_utils.h"
#include "hal/mipi_csi_brg_ll.h"
#include "soc/hp_sys_clkrst_struct.h"
#ifdef __cplusplus
extern "C" {
#endif
/*---------------------------------------------------------------
CSI Bridge
---------------------------------------------------------------*/
/**
* @brief Enable the bus clock for CSI Bridge module
*
* @param csi_bridge_id CSI Bridge ID
* @param en enable / disable
*/
static inline void mipi_csi_ll_enable_brg_module_clock(int csi_bridge_id, bool en)
{
HP_SYS_CLKRST.soc_clk_ctrl1.reg_csi_brg_sys_clk_en = en;
}
/// use a macro to wrap the function, force the caller to use it in a critical section
/// the critical section needs to declare the __DECLARE_RCC_ATOMIC_ENV variable in advance
#define mipi_csi_ll_enable_brg_module_clock(...) (void)__DECLARE_RCC_ATOMIC_ENV; mipi_csi_ll_enable_brg_module_clock(__VA_ARGS__)
/**
* @brief Reset the CSI Bridge module
*
* @param csi_bridge_id CSI Bridge ID
*/
static inline void mipi_csi_ll_reset_brg_module_clock(int csi_bridge_id)
{
HP_SYS_CLKRST.hp_rst_en0.reg_rst_en_csi_brg = 1;
HP_SYS_CLKRST.hp_rst_en0.reg_rst_en_csi_brg = 0;
}
/// use a macro to wrap the function, force the caller to use it in a critical section
/// the critical section needs to declare the __DECLARE_RCC_ATOMIC_ENV variable in advance
#define mipi_csi_ll_reset_brg_module_clock(...) (void)__DECLARE_RCC_ATOMIC_ENV; mipi_csi_ll_reset_brg_module_clock(__VA_ARGS__)
#ifdef __cplusplus
}
#endif

View File

@ -615,6 +615,10 @@ config SOC_ISP_AF_WINDOW_NUMS
int
default 3
config SOC_ISP_SHARE_CSI_BRG
bool
default y
config SOC_LEDC_SUPPORT_PLL_DIV_CLOCK
bool
default y

View File

@ -343,7 +343,7 @@ typedef union {
} csi_brg_host_ctrl_reg_t;
typedef struct {
typedef struct csi_brg_dev_t {
volatile csi_brg_clk_en_reg_t clk_en;
volatile csi_brg_csi_en_reg_t csi_en;
volatile csi_brg_dma_req_cfg_reg_t dma_req_cfg;
@ -361,6 +361,7 @@ typedef struct {
volatile csi_brg_host_ctrl_reg_t host_ctrl;
} csi_brg_dev_t;
extern csi_brg_dev_t MIPI_CSI_BRIDGE;
#ifndef __cplusplus
_Static_assert(sizeof(csi_brg_dev_t) == 0x44, "Invalid size of csi_brg_dev_t structure");

View File

@ -1815,7 +1815,7 @@ typedef union {
} csi_host_phy_stopstate_reg_t;
typedef struct {
typedef struct csi_host_dev_t {
volatile csi_host_version_reg_t version;
volatile csi_host_n_lanes_reg_t n_lanes;
volatile csi_host_csi2_resetn_reg_t csi2_resetn;
@ -1872,6 +1872,7 @@ typedef struct {
volatile csi_host_scrambling_seed2_reg_t scrambling_seed2;
} csi_host_dev_t;
extern csi_host_dev_t MIPI_CSI_HOST;
#ifndef __cplusplus
_Static_assert(sizeof(csi_host_dev_t) == 0x30c, "Invalid size of csi_host_dev_t structure");

View File

@ -275,6 +275,7 @@
#define SOC_ISP_AF_CTLR_NUMS 1U
#define SOC_ISP_AF_ENV_DETECTOR_NUMS 1U
#define SOC_ISP_AF_WINDOW_NUMS 3
#define SOC_ISP_SHARE_CSI_BRG 1
/*-------------------------- LEDC CAPS ---------------------------------------*/
#define SOC_LEDC_SUPPORT_PLL_DIV_CLOCK (1)