| /* SPDX-License-Identifier: GPL-2.0-only */ |
| |
| #include <cbfs.h> |
| #include <console/console.h> |
| #include <string.h> |
| #include <soc/qupv3_config.h> |
| |
| static struct elf_se_hdr *fw_list[SE_PROTOCOL_MAX]; |
| |
| void qupv3_se_fw_load_and_init(unsigned int bus, unsigned int protocol, |
| unsigned int mode) |
| { |
| uint32_t i; |
| uint32_t reg_value; |
| const uint8_t *cfg_idx_arr; |
| const uint32_t *cfg_val_arr; |
| const uint32_t *fw_val_arr; |
| struct elf_se_hdr *hdr; |
| struct qup_regs *regs = qup[bus].regs; |
| static const char * const filename[] = { |
| [SE_PROTOCOL_SPI] = "fallback/spi_fw", |
| [SE_PROTOCOL_UART] = "fallback/uart_fw", |
| [SE_PROTOCOL_I2C] = "fallback/i2c_fw", |
| }; |
| |
| if (protocol >= SE_PROTOCOL_MAX || !filename[protocol]) |
| die("*ERROR* * INVALID PROTOCOL ***\n"); |
| |
| if (!fw_list[protocol]) { |
| fw_list[protocol] = cbfs_boot_map_with_leak(filename[protocol], |
| CBFS_TYPE_RAW, NULL); |
| if (!fw_list[protocol]) |
| die("*ERROR* * cbfs_boot_map_with_leak failed ***\n"); |
| } |
| |
| hdr = fw_list[protocol]; |
| assert(hdr->magic == SEFW_MAGIC_HEADER) |
| |
| cfg_idx_arr = (const uint8_t *)hdr + hdr->cfg_idx_offset; |
| cfg_val_arr = (const uint32_t *)((uint8_t *)hdr + hdr->cfg_val_offset); |
| fw_val_arr = (const uint32_t *)((uint8_t *)hdr + hdr->fw_offset); |
| |
| /* Unlock SE for FW loading */ |
| write32(®s->se_geni_fw_multilock_protns, 0x0); |
| write32(®s->se_geni_fw_multilock_msa, 0x0); |
| |
| /* First, ensure GENI FW is disabled */ |
| write32(®s->geni_output_ctrl, 0x0); |
| clrbits_le32(®s->geni_dfs_if_cfg, GENI_DFS_IF_CFG_DFS_IF_EN_BMSK); |
| setbits_le32(®s->geni_cgc_ctrl, GENI_CGC_CTRL_PROG_RAM_SCLK_OFF_BMSK |
| | GENI_CGC_CTRL_PROG_RAM_HCLK_OFF_BMSK); |
| write32(®s->se_geni_clk_ctrl, 0x0); |
| clrbits_le32(®s->geni_cgc_ctrl, GENI_CGC_CTRL_PROG_RAM_SCLK_OFF_BMSK |
| | GENI_CGC_CTRL_PROG_RAM_HCLK_OFF_BMSK); |
| |
| /* HPG section 3.1.7.1 */ |
| if (protocol != SE_PROTOCOL_UART) { |
| setbits_le32(®s->geni_dfs_if_cfg, |
| GENI_DFS_IF_CFG_DFS_IF_EN_BMSK); |
| /* configure clock dfsr */ |
| clock_configure_dfsr(bus); |
| } |
| |
| /* HPG section 3.1.7.2 */ |
| /* No Init Required */ |
| |
| /* HPG section 3.1.7.3 */ |
| write32(®s->dma_general_cfg, |
| DMA_GENERAL_CFG_AHB_SEC_SLV_CLK_CGC_ON_BMSK | |
| DMA_GENERAL_CFG_DMA_AHB_SLV_CLK_CGC_ON_BMSK | |
| DMA_GENERAL_CFG_DMA_TX_CLK_CGC_ON_BMSK | |
| DMA_GENERAL_CFG_DMA_RX_CLK_CGC_ON_BMSK); |
| write32(®s->geni_cgc_ctrl, DEFAULT_CGC_EN); |
| |
| /* HPG section 3.1.7.4 */ |
| write32(®s->geni_init_cfg_revision, hdr->cfg_version); |
| write32(®s->geni_s_init_cfg_revision, hdr->cfg_version); |
| |
| assert(cfg_idx_arr[hdr->cfg_size_in_items - 1] * sizeof(uint32_t) <= |
| MAX_OFFSET_CFG_REG); |
| |
| for (i = 0; i < hdr->cfg_size_in_items; i++) { |
| write32(®s->geni_cfg_reg0 + cfg_idx_arr[i], |
| cfg_val_arr[i]); |
| } |
| |
| /* HPG section 3.1.7.9 */ |
| /* non-UART configuration, UART driver can configure as desired for UART |
| */ |
| write32(®s->geni_rx_rfr_watermark_reg, FIFO_DEPTH - 2); |
| |
| /* HPG section 3.1.7.5 */ |
| /* Don't change any SPI polarity, client driver will handle this */ |
| setbits_le32(®s->geni_output_ctrl, DEFAULT_IO_OUTPUT_CTRL_MSK); |
| |
| /* HPG section 3.1.7.6 */ |
| reg_value = read32(®s->geni_dma_mode_en); |
| if (mode == GSI) { |
| reg_value |= GENI_DMA_MODE_EN_GENI_DMA_MODE_EN_BMSK; |
| write32(®s->geni_dma_mode_en, reg_value); |
| write32(®s->se_irq_en, 0x0); |
| write32(®s->se_gsi_event_en, SE_GSI_EVENT_EN_BMSK); |
| } else if (mode == FIFO) { |
| reg_value &= ~GENI_DMA_MODE_EN_GENI_DMA_MODE_EN_BMSK; |
| write32(®s->geni_dma_mode_en, reg_value); |
| write32(®s->se_irq_en, SE_IRQ_EN_RMSK); |
| write32(®s->se_gsi_event_en, 0x0); |
| } else if (mode == CPU_DMA) { |
| reg_value |= GENI_DMA_MODE_EN_GENI_DMA_MODE_EN_BMSK; |
| write32(®s->geni_dma_mode_en, reg_value); |
| write32(®s->se_irq_en, SE_IRQ_EN_RMSK); |
| write32(®s->se_gsi_event_en, 0x0); |
| } |
| |
| /* HPG section 3.1.7.7 */ |
| write32(®s->geni_m_irq_enable, |
| M_COMMON_GENI_M_IRQ_EN); |
| reg_value = S_CMD_OVERRUN_EN | S_ILLEGAL_CMD_EN | |
| S_CMD_CANCEL_EN | S_CMD_ABORT_EN | |
| S_GP_IRQ_0_EN | S_GP_IRQ_1_EN | |
| S_GP_IRQ_2_EN | S_GP_IRQ_3_EN | |
| S_RX_FIFO_WR_ERR_EN | S_RX_FIFO_RD_ERR_EN; |
| write32(®s->geni_s_irq_enable, reg_value); |
| |
| /* HPG section 3.1.7.8 */ |
| /* GPI/DMA mode */ |
| reg_value = DMA_TX_IRQ_EN_SET_RESET_DONE_EN_SET_BMSK | |
| DMA_TX_IRQ_EN_SET_SBE_EN_SET_BMSK | |
| DMA_TX_IRQ_EN_SET_DMA_DONE_EN_SET_BMSK; |
| write32(®s->dma_tx_irq_en_set, reg_value); |
| |
| reg_value = DMA_RX_IRQ_EN_SET_FLUSH_DONE_EN_SET_BMSK | |
| DMA_RX_IRQ_EN_SET_RESET_DONE_EN_SET_BMSK | |
| DMA_RX_IRQ_EN_SET_SBE_EN_SET_BMSK | |
| DMA_RX_IRQ_EN_SET_DMA_DONE_EN_SET_BMSK; |
| write32(®s->dma_rx_irq_en_set, reg_value); |
| |
| /* HPG section 3.1.7.10 */ |
| reg_value = (hdr->serial_protocol << FW_REV_PROTOCOL_SHFT) | |
| (hdr->fw_version & 0xFF << |
| FW_REV_VERSION_SHFT); |
| write32(®s->se_geni_fw_revision, reg_value); |
| |
| reg_value = |
| (hdr->serial_protocol << FW_REV_PROTOCOL_SHFT) | |
| (hdr->fw_version & 0xFF << |
| FW_REV_VERSION_SHFT); |
| write32(®s->se_s_fw_revision, reg_value); |
| |
| assert(hdr->fw_size_in_items <= SIZE_GENI_FW_RAM); |
| |
| memcpy((®s->se_geni_cfg_ramn), fw_val_arr, |
| hdr->fw_size_in_items * sizeof(uint32_t)); |
| |
| /* HPG section 3.1.7.12 */ |
| write32(®s->geni_force_default_reg, 0x1); |
| setbits_le32(®s->geni_cgc_ctrl, GENI_CGC_CTRL_PROG_RAM_SCLK_OFF_BMSK |
| |GENI_CGC_CTRL_PROG_RAM_HCLK_OFF_BMSK); |
| setbits_le32(®s->se_geni_clk_ctrl, GENI_CLK_CTRL_SER_CLK_SEL_BMSK); |
| clrbits_le32(®s->geni_cgc_ctrl, |
| (GENI_CGC_CTRL_PROG_RAM_SCLK_OFF_BMSK | |
| GENI_CGC_CTRL_PROG_RAM_HCLK_OFF_BMSK)); |
| |
| /* HPG section 3.1.7.13 */ |
| /* GSI/DMA mode */ |
| setbits_le32(®s->se_dma_if_en, DMA_IF_EN_DMA_IF_EN_BMSK); |
| |
| /* HPG section 3.1.7.14 */ |
| reg_value = read32(®s->se_fifo_if_disable); |
| if ((mode == MIXED) || (mode == FIFO)) |
| reg_value &= ~FIFO_IF_DISABLE; |
| else |
| reg_value |= FIFO_IF_DISABLE; |
| write32(®s->se_fifo_if_disable, reg_value); |
| write32(®s->se_geni_clk_ctrl, 0x1); |
| |
| /* Lock SE from FW loading */ |
| write32(®s->se_geni_fw_multilock_protns, 0x1); |
| write32(®s->se_geni_fw_multilock_msa, 0x1); |
| } |
| |
| static void qup_common_init(int addr) |
| { |
| struct qupv3_common_reg *qupv3_common; |
| /* HPG section 3.1.2 */ |
| qupv3_common = (struct qupv3_common_reg *)(uintptr_t) addr; |
| setbits32(&qupv3_common->qupv3_common_cfg_reg, |
| QUPV3_COMMON_CFG_FAST_SWITCH_TO_HIGH_DISABLE_BMSK); |
| |
| /* HPG section 3.1.7.3 */ |
| setbits32(&qupv3_common->qupv3_se_ahb_m_cfg_reg, |
| QUPV3_SE_AHB_M_CFG_AHB_M_CLK_CGC_ON_BMSK); |
| } |
| |
| void qupv3_fw_init(void) |
| { |
| uint8_t i; |
| |
| /* Turn on all QUP clocks */ |
| for (i = 0; i < QUPV3_SE_MAX; i++) |
| clock_enable_qup(i); |
| |
| qup_common_init(QUP_WRAP0_BASE); |
| qup_common_init(QUP_WRAP1_BASE); |
| } |