1516e8f0fSTodor Tomov // SPDX-License-Identifier: GPL-2.0 2516e8f0fSTodor Tomov /* 3516e8f0fSTodor Tomov * camss-csiphy-2ph-1-0.c 4516e8f0fSTodor Tomov * 5516e8f0fSTodor Tomov * Qualcomm MSM Camera Subsystem - CSIPHY Module 2phase v1.0 6516e8f0fSTodor Tomov * 7516e8f0fSTodor Tomov * Copyright (c) 2011-2015, The Linux Foundation. All rights reserved. 8516e8f0fSTodor Tomov * Copyright (C) 2016-2018 Linaro Ltd. 9516e8f0fSTodor Tomov */ 10516e8f0fSTodor Tomov 11516e8f0fSTodor Tomov #include "camss-csiphy.h" 12516e8f0fSTodor Tomov 13516e8f0fSTodor Tomov #include <linux/delay.h> 14516e8f0fSTodor Tomov #include <linux/interrupt.h> 153799eca5SArnd Bergmann #include <linux/io.h> 16516e8f0fSTodor Tomov 17516e8f0fSTodor Tomov #define CAMSS_CSI_PHY_LNn_CFG2(n) (0x004 + 0x40 * (n)) 18516e8f0fSTodor Tomov #define CAMSS_CSI_PHY_LNn_CFG3(n) (0x008 + 0x40 * (n)) 19516e8f0fSTodor Tomov #define CAMSS_CSI_PHY_GLBL_RESET 0x140 20516e8f0fSTodor Tomov #define CAMSS_CSI_PHY_GLBL_PWR_CFG 0x144 21516e8f0fSTodor Tomov #define CAMSS_CSI_PHY_GLBL_IRQ_CMD 0x164 22516e8f0fSTodor Tomov #define CAMSS_CSI_PHY_HW_VERSION 0x188 23516e8f0fSTodor Tomov #define CAMSS_CSI_PHY_INTERRUPT_STATUSn(n) (0x18c + 0x4 * (n)) 24516e8f0fSTodor Tomov #define CAMSS_CSI_PHY_INTERRUPT_MASKn(n) (0x1ac + 0x4 * (n)) 25516e8f0fSTodor Tomov #define CAMSS_CSI_PHY_INTERRUPT_CLEARn(n) (0x1cc + 0x4 * (n)) 26516e8f0fSTodor Tomov #define CAMSS_CSI_PHY_GLBL_T_INIT_CFG0 0x1ec 27516e8f0fSTodor Tomov #define CAMSS_CSI_PHY_T_WAKEUP_CFG0 0x1f4 28516e8f0fSTodor Tomov 29516e8f0fSTodor Tomov static void csiphy_hw_version_read(struct csiphy_device *csiphy, 30516e8f0fSTodor Tomov struct device *dev) 31516e8f0fSTodor Tomov { 32516e8f0fSTodor Tomov u8 hw_version = readl_relaxed(csiphy->base + 33516e8f0fSTodor Tomov CAMSS_CSI_PHY_HW_VERSION); 34516e8f0fSTodor Tomov 35516e8f0fSTodor Tomov dev_dbg(dev, "CSIPHY HW Version = 0x%02x\n", hw_version); 36516e8f0fSTodor Tomov } 37516e8f0fSTodor Tomov 38516e8f0fSTodor Tomov /* 39516e8f0fSTodor Tomov * csiphy_reset - Perform software reset on CSIPHY module 40516e8f0fSTodor Tomov * @csiphy: CSIPHY device 41516e8f0fSTodor Tomov */ 42516e8f0fSTodor Tomov static void csiphy_reset(struct csiphy_device *csiphy) 43516e8f0fSTodor Tomov { 44516e8f0fSTodor Tomov writel_relaxed(0x1, csiphy->base + CAMSS_CSI_PHY_GLBL_RESET); 45516e8f0fSTodor Tomov usleep_range(5000, 8000); 46516e8f0fSTodor Tomov writel_relaxed(0x0, csiphy->base + CAMSS_CSI_PHY_GLBL_RESET); 47516e8f0fSTodor Tomov } 48516e8f0fSTodor Tomov 49516e8f0fSTodor Tomov /* 50516e8f0fSTodor Tomov * csiphy_settle_cnt_calc - Calculate settle count value 51516e8f0fSTodor Tomov * 52516e8f0fSTodor Tomov * Helper function to calculate settle count value. This is 53516e8f0fSTodor Tomov * based on the CSI2 T_hs_settle parameter which in turn 54516e8f0fSTodor Tomov * is calculated based on the CSI2 transmitter pixel clock 55516e8f0fSTodor Tomov * frequency. 56516e8f0fSTodor Tomov * 57516e8f0fSTodor Tomov * Return settle count value or 0 if the CSI2 pixel clock 58516e8f0fSTodor Tomov * frequency is not available 59516e8f0fSTodor Tomov */ 60516e8f0fSTodor Tomov static u8 csiphy_settle_cnt_calc(u32 pixel_clock, u8 bpp, u8 num_lanes, 61516e8f0fSTodor Tomov u32 timer_clk_rate) 62516e8f0fSTodor Tomov { 63516e8f0fSTodor Tomov u32 mipi_clock; /* Hz */ 64516e8f0fSTodor Tomov u32 ui; /* ps */ 65516e8f0fSTodor Tomov u32 timer_period; /* ps */ 66516e8f0fSTodor Tomov u32 t_hs_prepare_max; /* ps */ 67516e8f0fSTodor Tomov u32 t_hs_prepare_zero_min; /* ps */ 68516e8f0fSTodor Tomov u32 t_hs_settle; /* ps */ 69516e8f0fSTodor Tomov u8 settle_cnt; 70516e8f0fSTodor Tomov 71516e8f0fSTodor Tomov mipi_clock = pixel_clock * bpp / (2 * num_lanes); 72516e8f0fSTodor Tomov ui = div_u64(1000000000000LL, mipi_clock); 73516e8f0fSTodor Tomov ui /= 2; 74516e8f0fSTodor Tomov t_hs_prepare_max = 85000 + 6 * ui; 75516e8f0fSTodor Tomov t_hs_prepare_zero_min = 145000 + 10 * ui; 76516e8f0fSTodor Tomov t_hs_settle = (t_hs_prepare_max + t_hs_prepare_zero_min) / 2; 77516e8f0fSTodor Tomov 78516e8f0fSTodor Tomov timer_period = div_u64(1000000000000LL, timer_clk_rate); 79516e8f0fSTodor Tomov settle_cnt = t_hs_settle / timer_period - 1; 80516e8f0fSTodor Tomov 81516e8f0fSTodor Tomov return settle_cnt; 82516e8f0fSTodor Tomov } 83516e8f0fSTodor Tomov 84516e8f0fSTodor Tomov static void csiphy_lanes_enable(struct csiphy_device *csiphy, 85516e8f0fSTodor Tomov struct csiphy_config *cfg, 86516e8f0fSTodor Tomov u32 pixel_clock, u8 bpp, u8 lane_mask) 87516e8f0fSTodor Tomov { 88516e8f0fSTodor Tomov struct csiphy_lanes_cfg *c = &cfg->csi2->lane_cfg; 89516e8f0fSTodor Tomov u8 settle_cnt; 90369f81f3STodor Tomov u8 val, l = 0; 91516e8f0fSTodor Tomov int i = 0; 92516e8f0fSTodor Tomov 93516e8f0fSTodor Tomov settle_cnt = csiphy_settle_cnt_calc(pixel_clock, bpp, c->num_data, 94516e8f0fSTodor Tomov csiphy->timer_clk_rate); 95516e8f0fSTodor Tomov 96516e8f0fSTodor Tomov writel_relaxed(0x1, csiphy->base + 97516e8f0fSTodor Tomov CAMSS_CSI_PHY_GLBL_T_INIT_CFG0); 98516e8f0fSTodor Tomov writel_relaxed(0x1, csiphy->base + 99516e8f0fSTodor Tomov CAMSS_CSI_PHY_T_WAKEUP_CFG0); 100516e8f0fSTodor Tomov 101516e8f0fSTodor Tomov val = 0x1; 102516e8f0fSTodor Tomov val |= lane_mask << 1; 103516e8f0fSTodor Tomov writel_relaxed(val, csiphy->base + CAMSS_CSI_PHY_GLBL_PWR_CFG); 104516e8f0fSTodor Tomov 105516e8f0fSTodor Tomov val = cfg->combo_mode << 4; 106516e8f0fSTodor Tomov writel_relaxed(val, csiphy->base + CAMSS_CSI_PHY_GLBL_RESET); 107516e8f0fSTodor Tomov 108369f81f3STodor Tomov for (i = 0; i <= c->num_data; i++) { 109369f81f3STodor Tomov if (i == c->num_data) 110369f81f3STodor Tomov l = c->clk.pos; 111369f81f3STodor Tomov else 112369f81f3STodor Tomov l = c->data[i].pos; 113369f81f3STodor Tomov 114516e8f0fSTodor Tomov writel_relaxed(0x10, csiphy->base + 115369f81f3STodor Tomov CAMSS_CSI_PHY_LNn_CFG2(l)); 116516e8f0fSTodor Tomov writel_relaxed(settle_cnt, csiphy->base + 117369f81f3STodor Tomov CAMSS_CSI_PHY_LNn_CFG3(l)); 118516e8f0fSTodor Tomov writel_relaxed(0x3f, csiphy->base + 119369f81f3STodor Tomov CAMSS_CSI_PHY_INTERRUPT_MASKn(l)); 120516e8f0fSTodor Tomov writel_relaxed(0x3f, csiphy->base + 121369f81f3STodor Tomov CAMSS_CSI_PHY_INTERRUPT_CLEARn(l)); 122516e8f0fSTodor Tomov } 123516e8f0fSTodor Tomov } 124516e8f0fSTodor Tomov 125369f81f3STodor Tomov static void csiphy_lanes_disable(struct csiphy_device *csiphy, 126369f81f3STodor Tomov struct csiphy_config *cfg) 127516e8f0fSTodor Tomov { 128369f81f3STodor Tomov struct csiphy_lanes_cfg *c = &cfg->csi2->lane_cfg; 129369f81f3STodor Tomov u8 l = 0; 130516e8f0fSTodor Tomov int i = 0; 131516e8f0fSTodor Tomov 132369f81f3STodor Tomov for (i = 0; i <= c->num_data; i++) { 133369f81f3STodor Tomov if (i == c->num_data) 134369f81f3STodor Tomov l = c->clk.pos; 135369f81f3STodor Tomov else 136369f81f3STodor Tomov l = c->data[i].pos; 137516e8f0fSTodor Tomov 138369f81f3STodor Tomov writel_relaxed(0x0, csiphy->base + 139369f81f3STodor Tomov CAMSS_CSI_PHY_LNn_CFG2(l)); 140516e8f0fSTodor Tomov } 141516e8f0fSTodor Tomov 142516e8f0fSTodor Tomov writel_relaxed(0x0, csiphy->base + CAMSS_CSI_PHY_GLBL_PWR_CFG); 143516e8f0fSTodor Tomov } 144516e8f0fSTodor Tomov 145516e8f0fSTodor Tomov /* 146516e8f0fSTodor Tomov * csiphy_isr - CSIPHY module interrupt handler 147516e8f0fSTodor Tomov * @irq: Interrupt line 148516e8f0fSTodor Tomov * @dev: CSIPHY device 149516e8f0fSTodor Tomov * 150516e8f0fSTodor Tomov * Return IRQ_HANDLED on success 151516e8f0fSTodor Tomov */ 152516e8f0fSTodor Tomov static irqreturn_t csiphy_isr(int irq, void *dev) 153516e8f0fSTodor Tomov { 154516e8f0fSTodor Tomov struct csiphy_device *csiphy = dev; 155516e8f0fSTodor Tomov u8 i; 156516e8f0fSTodor Tomov 157516e8f0fSTodor Tomov for (i = 0; i < 8; i++) { 158516e8f0fSTodor Tomov u8 val = readl_relaxed(csiphy->base + 159516e8f0fSTodor Tomov CAMSS_CSI_PHY_INTERRUPT_STATUSn(i)); 160516e8f0fSTodor Tomov writel_relaxed(val, csiphy->base + 161516e8f0fSTodor Tomov CAMSS_CSI_PHY_INTERRUPT_CLEARn(i)); 162516e8f0fSTodor Tomov writel_relaxed(0x1, csiphy->base + CAMSS_CSI_PHY_GLBL_IRQ_CMD); 163516e8f0fSTodor Tomov writel_relaxed(0x0, csiphy->base + CAMSS_CSI_PHY_GLBL_IRQ_CMD); 164516e8f0fSTodor Tomov writel_relaxed(0x0, csiphy->base + 165516e8f0fSTodor Tomov CAMSS_CSI_PHY_INTERRUPT_CLEARn(i)); 166516e8f0fSTodor Tomov } 167516e8f0fSTodor Tomov 168516e8f0fSTodor Tomov return IRQ_HANDLED; 169516e8f0fSTodor Tomov } 170516e8f0fSTodor Tomov 171516e8f0fSTodor Tomov const struct csiphy_hw_ops csiphy_ops_2ph_1_0 = { 172516e8f0fSTodor Tomov .hw_version_read = csiphy_hw_version_read, 173516e8f0fSTodor Tomov .reset = csiphy_reset, 174516e8f0fSTodor Tomov .lanes_enable = csiphy_lanes_enable, 175516e8f0fSTodor Tomov .lanes_disable = csiphy_lanes_disable, 176516e8f0fSTodor Tomov .isr = csiphy_isr, 177516e8f0fSTodor Tomov }; 178