mirror of
				https://xff.cz/git/u-boot/
				synced 2025-10-31 10:26:10 +01:00 
			
		
		
		
	When using OF_LIVE, the debug UART driver won't be probed if it's a subnode of the geni-se-qup controller. Add a NOP driver for the controller to correctly discover its child nodes. Reviewed-by: Neil Armstrong <neil.armstrong@linaro.org> Reviewed-by: Sumit Garg <sumit.garg@linaro.org> Signed-off-by: Caleb Connolly <caleb.connolly@linaro.org>
		
			
				
	
	
		
			667 lines
		
	
	
		
			18 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			667 lines
		
	
	
		
			18 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| // SPDX-License-Identifier: GPL-2.0+
 | |
| /*
 | |
|  * Qualcomm GENI serial engine UART driver
 | |
|  *
 | |
|  * (C) Copyright 2021 Dzmitry Sankouski <dsankouski@gmail.com>
 | |
|  *
 | |
|  * Based on Linux driver.
 | |
|  */
 | |
| 
 | |
| #include <asm/io.h>
 | |
| #include <clk.h>
 | |
| #include <common.h>
 | |
| #include <dm.h>
 | |
| #include <errno.h>
 | |
| #include <linux/delay.h>
 | |
| #include <linux/time.h>
 | |
| #include <misc.h>
 | |
| #include <serial.h>
 | |
| 
 | |
| #define UART_OVERSAMPLING	32
 | |
| #define STALE_TIMEOUT	160
 | |
| 
 | |
| /* Registers*/
 | |
| #define GENI_FORCE_DEFAULT_REG	0x20
 | |
| #define GENI_SER_M_CLK_CFG	0x48
 | |
| #define GENI_SER_S_CLK_CFG	0x4C
 | |
| #define SE_HW_PARAM_0	0xE24
 | |
| #define SE_GENI_STATUS	0x40
 | |
| #define SE_GENI_S_CMD0	0x630
 | |
| #define SE_GENI_S_CMD_CTRL_REG	0x634
 | |
| #define SE_GENI_S_IRQ_CLEAR	0x648
 | |
| #define SE_GENI_S_IRQ_STATUS	0x640
 | |
| #define SE_GENI_S_IRQ_EN	0x644
 | |
| #define SE_GENI_M_CMD0	0x600
 | |
| #define SE_GENI_M_CMD_CTRL_REG	0x604
 | |
| #define SE_GENI_M_IRQ_CLEAR	0x618
 | |
| #define SE_GENI_M_IRQ_STATUS	0x610
 | |
| #define SE_GENI_M_IRQ_EN	0x614
 | |
| #define SE_GENI_TX_FIFOn	0x700
 | |
| #define SE_GENI_RX_FIFOn	0x780
 | |
| #define SE_GENI_TX_FIFO_STATUS	0x800
 | |
| #define SE_GENI_RX_FIFO_STATUS	0x804
 | |
| #define SE_GENI_TX_WATERMARK_REG	0x80C
 | |
| #define SE_GENI_TX_PACKING_CFG0	0x260
 | |
| #define SE_GENI_TX_PACKING_CFG1	0x264
 | |
| #define SE_GENI_RX_PACKING_CFG0	0x284
 | |
| #define SE_GENI_RX_PACKING_CFG1	0x288
 | |
| #define SE_UART_RX_STALE_CNT	0x294
 | |
| #define SE_UART_TX_TRANS_LEN	0x270
 | |
| #define SE_UART_TX_STOP_BIT_LEN	0x26c
 | |
| #define SE_UART_TX_WORD_LEN	0x268
 | |
| #define SE_UART_RX_WORD_LEN	0x28c
 | |
| #define SE_UART_TX_TRANS_CFG	0x25c
 | |
| #define SE_UART_TX_PARITY_CFG	0x2a4
 | |
| #define SE_UART_RX_TRANS_CFG	0x280
 | |
| #define SE_UART_RX_PARITY_CFG	0x2a8
 | |
| 
 | |
| #define M_TX_FIFO_WATERMARK_EN	(BIT(30))
 | |
| #define DEF_TX_WM	2
 | |
| /* GENI_FORCE_DEFAULT_REG fields */
 | |
| #define FORCE_DEFAULT	(BIT(0))
 | |
| 
 | |
| #define S_CMD_ABORT_EN	(BIT(5))
 | |
| 
 | |
| #define UART_START_READ	0x1
 | |
| 
 | |
| /* GENI_M_CMD_CTRL_REG */
 | |
| #define M_GENI_CMD_CANCEL	(BIT(2))
 | |
| #define M_GENI_CMD_ABORT	(BIT(1))
 | |
| #define M_GENI_DISABLE	(BIT(0))
 | |
| 
 | |
| #define M_CMD_ABORT_EN	(BIT(5))
 | |
| #define M_CMD_DONE_EN	(BIT(0))
 | |
| #define M_CMD_DONE_DISABLE_MASK	(~M_CMD_DONE_EN)
 | |
| 
 | |
| #define S_GENI_CMD_ABORT	(BIT(1))
 | |
| 
 | |
| /* GENI_S_CMD0 fields */
 | |
| #define S_OPCODE_MSK	(GENMASK(31, 27))
 | |
| #define S_PARAMS_MSK	(GENMASK(26, 0))
 | |
| 
 | |
| /* GENI_STATUS fields */
 | |
| #define M_GENI_CMD_ACTIVE	(BIT(0))
 | |
| #define S_GENI_CMD_ACTIVE	(BIT(12))
 | |
| #define M_CMD_DONE_EN	(BIT(0))
 | |
| #define S_CMD_DONE_EN	(BIT(0))
 | |
| 
 | |
| #define M_OPCODE_SHIFT	27
 | |
| #define S_OPCODE_SHIFT	27
 | |
| #define M_TX_FIFO_WATERMARK_EN	(BIT(30))
 | |
| #define UART_START_TX	0x1
 | |
| #define UART_CTS_MASK	(BIT(1))
 | |
| #define M_SEC_IRQ_EN	(BIT(31))
 | |
| #define TX_FIFO_WC_MSK	(GENMASK(27, 0))
 | |
| #define RX_FIFO_WC_MSK	(GENMASK(24, 0))
 | |
| 
 | |
| #define S_RX_FIFO_WATERMARK_EN	(BIT(26))
 | |
| #define S_RX_FIFO_LAST_EN	(BIT(27))
 | |
| #define M_RX_FIFO_WATERMARK_EN	(BIT(26))
 | |
| #define M_RX_FIFO_LAST_EN	(BIT(27))
 | |
| 
 | |
| /* GENI_SER_M_CLK_CFG/GENI_SER_S_CLK_CFG */
 | |
| #define SER_CLK_EN	(BIT(0))
 | |
| #define CLK_DIV_MSK	(GENMASK(15, 4))
 | |
| #define CLK_DIV_SHFT	4
 | |
| 
 | |
| /* SE_HW_PARAM_0 fields */
 | |
| #define TX_FIFO_WIDTH_MSK	(GENMASK(29, 24))
 | |
| #define TX_FIFO_WIDTH_SHFT	24
 | |
| #define TX_FIFO_DEPTH_MSK	(GENMASK(21, 16))
 | |
| #define TX_FIFO_DEPTH_SHFT	16
 | |
| 
 | |
| /* GENI SE QUP Registers */
 | |
| #define QUP_HW_VER_REG		0x4
 | |
| #define  QUP_SE_VERSION_2_5	0x20050000
 | |
| 
 | |
| /*
 | |
|  * Predefined packing configuration of the serial engine (CFG0, CFG1 regs)
 | |
|  * for uart mode.
 | |
|  *
 | |
|  * Defines following configuration:
 | |
|  * - Bits of data per transfer word             8
 | |
|  * - Number of words per fifo element           4
 | |
|  * - Transfer from MSB to LSB or vice-versa     false
 | |
|  */
 | |
| #define UART_PACKING_CFG0   0xf
 | |
| #define UART_PACKING_CFG1   0x0
 | |
| 
 | |
| DECLARE_GLOBAL_DATA_PTR;
 | |
| 
 | |
| struct msm_serial_data {
 | |
| 	phys_addr_t base;
 | |
| 	u32 baud;
 | |
| 	u32 oversampling;
 | |
| };
 | |
| 
 | |
| unsigned long root_freq[] = {7372800,  14745600, 19200000, 29491200,
 | |
| 			     32000000, 48000000, 64000000, 80000000,
 | |
| 			     96000000, 100000000};
 | |
| 
 | |
| /**
 | |
|  * get_clk_cfg() - Get clock rate to apply on clock supplier.
 | |
|  * @clk_freq:	Desired clock frequency after build-in divider.
 | |
|  *
 | |
|  * Return: frequency, supported by clock supplier, multiple of clk_freq.
 | |
|  */
 | |
| static int get_clk_cfg(unsigned long clk_freq)
 | |
| {
 | |
| 	for (int i = 0; i < ARRAY_SIZE(root_freq); i++) {
 | |
| 		if (!(root_freq[i] % clk_freq))
 | |
| 			return root_freq[i];
 | |
| 	}
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * get_clk_div_rate() - Find clock supplier frequency, and calculate divisor.
 | |
|  * @baud:	        Baudrate.
 | |
|  * @sampling_rate:	Clock ticks per character.
 | |
|  * @clk_div:	    Pointer to calculated divisor.
 | |
|  *
 | |
|  * This function searches for suitable frequency for clock supplier,
 | |
|  * calculates divisor for internal divider, based on found frequency,
 | |
|  * and stores divisor under clk_div pointer.
 | |
|  *
 | |
|  * Return: frequency, supported by clock supplier, multiple of clk_freq.
 | |
|  */
 | |
| static int get_clk_div_rate(u32 baud, u64 sampling_rate, u32 *clk_div)
 | |
| {
 | |
| 	unsigned long ser_clk;
 | |
| 	unsigned long desired_clk;
 | |
| 
 | |
| 	desired_clk = baud * sampling_rate;
 | |
| 	ser_clk = get_clk_cfg(desired_clk);
 | |
| 	if (!ser_clk) {
 | |
| 		pr_err("%s: Can't find matching DFS entry for baud %d\n",
 | |
| 								__func__, baud);
 | |
| 		return ser_clk;
 | |
| 	}
 | |
| 
 | |
| 	*clk_div = ser_clk / desired_clk;
 | |
| 	return ser_clk;
 | |
| }
 | |
| 
 | |
| static int geni_serial_set_clock_rate(struct udevice *dev, u64 rate)
 | |
| {
 | |
| 	struct clk *clk;
 | |
| 	int ret;
 | |
| 
 | |
| 	clk = devm_clk_get(dev, NULL);
 | |
| 	if (IS_ERR(clk))
 | |
| 		return PTR_ERR(clk);
 | |
| 
 | |
| 	ret = clk_set_rate(clk, rate);
 | |
| 	return ret;
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * geni_se_get_tx_fifo_depth() - Get the TX fifo depth of the serial engine
 | |
|  * @base:	Pointer to the concerned serial engine.
 | |
|  *
 | |
|  * This function is used to get the depth i.e. number of elements in the
 | |
|  * TX fifo of the serial engine.
 | |
|  *
 | |
|  * Return: TX fifo depth in units of FIFO words.
 | |
|  */
 | |
| static inline u32 geni_se_get_tx_fifo_depth(long base)
 | |
| {
 | |
| 	u32 tx_fifo_depth;
 | |
| 
 | |
| 	tx_fifo_depth = ((readl(base + SE_HW_PARAM_0) & TX_FIFO_DEPTH_MSK) >>
 | |
| 			 TX_FIFO_DEPTH_SHFT);
 | |
| 	return tx_fifo_depth;
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * geni_se_get_tx_fifo_width() - Get the TX fifo width of the serial engine
 | |
|  * @base:	Pointer to the concerned serial engine.
 | |
|  *
 | |
|  * This function is used to get the width i.e. word size per element in the
 | |
|  * TX fifo of the serial engine.
 | |
|  *
 | |
|  * Return: TX fifo width in bits
 | |
|  */
 | |
| static inline u32 geni_se_get_tx_fifo_width(long base)
 | |
| {
 | |
| 	u32 tx_fifo_width;
 | |
| 
 | |
| 	tx_fifo_width = ((readl(base + SE_HW_PARAM_0) & TX_FIFO_WIDTH_MSK) >>
 | |
| 			 TX_FIFO_WIDTH_SHFT);
 | |
| 	return tx_fifo_width;
 | |
| }
 | |
| 
 | |
| static inline void geni_serial_baud(phys_addr_t base_address, u32 clk_div,
 | |
| 				    int baud)
 | |
| {
 | |
| 	u32 s_clk_cfg = 0;
 | |
| 
 | |
| 	s_clk_cfg |= SER_CLK_EN;
 | |
| 	s_clk_cfg |= (clk_div << CLK_DIV_SHFT);
 | |
| 
 | |
| 	writel(s_clk_cfg, base_address + GENI_SER_M_CLK_CFG);
 | |
| 	writel(s_clk_cfg, base_address + GENI_SER_S_CLK_CFG);
 | |
| }
 | |
| 
 | |
| static int msm_serial_setbrg(struct udevice *dev, int baud)
 | |
| {
 | |
| 	struct msm_serial_data *priv = dev_get_priv(dev);
 | |
| 	u64 clk_rate;
 | |
| 	u32 clk_div;
 | |
| 	int ret;
 | |
| 
 | |
| 	priv->baud = baud;
 | |
| 
 | |
| 	clk_rate = get_clk_div_rate(baud, priv->oversampling, &clk_div);
 | |
| 	ret = geni_serial_set_clock_rate(dev, clk_rate);
 | |
| 	if (ret < 0) {
 | |
| 		pr_err("%s: Couldn't set clock rate: %d\n", __func__, ret);
 | |
| 		return ret;
 | |
| 	}
 | |
| 	geni_serial_baud(priv->base, clk_div, baud);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * qcom_geni_serial_poll_bit() - Poll reg bit until desired value or timeout.
 | |
|  * @base:	Pointer to the concerned serial engine.
 | |
|  * @offset:	Offset to register address.
 | |
|  * @field:	AND bitmask for desired bit.
 | |
|  * @set:	Desired bit value.
 | |
|  *
 | |
|  * This function is used to get the width i.e. word size per element in the
 | |
|  * TX fifo of the serial engine.
 | |
|  *
 | |
|  * Return: true, when register bit equals desired value, false, when timeout
 | |
|  * reached.
 | |
|  */
 | |
| static bool qcom_geni_serial_poll_bit(const struct udevice *dev, int offset,
 | |
| 				      int field, bool set)
 | |
| {
 | |
| 	u32 reg;
 | |
| 	struct msm_serial_data *priv = dev_get_priv(dev);
 | |
| 	unsigned int baud;
 | |
| 	unsigned int tx_fifo_depth;
 | |
| 	unsigned int tx_fifo_width;
 | |
| 	unsigned int fifo_bits;
 | |
| 	unsigned long timeout_us = 10000;
 | |
| 
 | |
| 	baud = 115200;
 | |
| 
 | |
| 	if (priv) {
 | |
| 		baud = priv->baud;
 | |
| 		if (!baud)
 | |
| 			baud = 115200;
 | |
| 		tx_fifo_depth = geni_se_get_tx_fifo_depth(priv->base);
 | |
| 		tx_fifo_width = geni_se_get_tx_fifo_width(priv->base);
 | |
| 		fifo_bits = tx_fifo_depth * tx_fifo_width;
 | |
| 		/*
 | |
| 		 * Total polling iterations based on FIFO worth of bytes to be
 | |
| 		 * sent at current baud. Add a little fluff to the wait.
 | |
| 		 */
 | |
| 		timeout_us = ((fifo_bits * USEC_PER_SEC) / baud) + 500;
 | |
| 	}
 | |
| 
 | |
| 	timeout_us = DIV_ROUND_UP(timeout_us, 10) * 10;
 | |
| 	while (timeout_us) {
 | |
| 		reg = readl(priv->base + offset);
 | |
| 		if ((bool)(reg & field) == set)
 | |
| 			return true;
 | |
| 		udelay(10);
 | |
| 		timeout_us -= 10;
 | |
| 	}
 | |
| 	return false;
 | |
| }
 | |
| 
 | |
| static void qcom_geni_serial_setup_tx(u64 base, u32 xmit_size)
 | |
| {
 | |
| 	u32 m_cmd;
 | |
| 
 | |
| 	writel(xmit_size, base + SE_UART_TX_TRANS_LEN);
 | |
| 	m_cmd = UART_START_TX << M_OPCODE_SHIFT;
 | |
| 	writel(m_cmd, base + SE_GENI_M_CMD0);
 | |
| }
 | |
| 
 | |
| static inline void qcom_geni_serial_poll_tx_done(const struct udevice *dev)
 | |
| {
 | |
| 	struct msm_serial_data *priv = dev_get_priv(dev);
 | |
| 	int done = 0;
 | |
| 	u32 irq_clear = M_CMD_DONE_EN;
 | |
| 
 | |
| 	done = qcom_geni_serial_poll_bit(dev, SE_GENI_M_IRQ_STATUS,
 | |
| 					 M_CMD_DONE_EN, true);
 | |
| 	if (!done) {
 | |
| 		writel(M_GENI_CMD_ABORT, priv->base + SE_GENI_M_CMD_CTRL_REG);
 | |
| 		irq_clear |= M_CMD_ABORT_EN;
 | |
| 		qcom_geni_serial_poll_bit(dev, SE_GENI_M_IRQ_STATUS,
 | |
| 					  M_CMD_ABORT_EN, true);
 | |
| 	}
 | |
| 	writel(irq_clear, priv->base + SE_GENI_M_IRQ_CLEAR);
 | |
| }
 | |
| 
 | |
| static u32 qcom_geni_serial_tx_empty(u64 base)
 | |
| {
 | |
| 	return !readl(base + SE_GENI_TX_FIFO_STATUS);
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * geni_se_setup_s_cmd() - Setup the secondary sequencer
 | |
|  * @se:		Pointer to the concerned serial engine.
 | |
|  * @cmd:	Command/Operation to setup in the secondary sequencer.
 | |
|  * @params:	Parameter for the sequencer command.
 | |
|  *
 | |
|  * This function is used to configure the secondary sequencer with the
 | |
|  * command and its associated parameters.
 | |
|  */
 | |
| static inline void geni_se_setup_s_cmd(u64 base, u32 cmd, u32 params)
 | |
| {
 | |
| 	u32 s_cmd;
 | |
| 
 | |
| 	s_cmd = readl(base + SE_GENI_S_CMD0);
 | |
| 	s_cmd &= ~(S_OPCODE_MSK | S_PARAMS_MSK);
 | |
| 	s_cmd |= (cmd << S_OPCODE_SHIFT);
 | |
| 	s_cmd |= (params & S_PARAMS_MSK);
 | |
| 	writel(s_cmd, base + SE_GENI_S_CMD0);
 | |
| }
 | |
| 
 | |
| static void qcom_geni_serial_start_tx(u64 base)
 | |
| {
 | |
| 	u32 irq_en;
 | |
| 	u32 status;
 | |
| 
 | |
| 	status = readl(base + SE_GENI_STATUS);
 | |
| 	if (status & M_GENI_CMD_ACTIVE)
 | |
| 		return;
 | |
| 
 | |
| 	if (!qcom_geni_serial_tx_empty(base))
 | |
| 		return;
 | |
| 
 | |
| 	irq_en = readl(base + SE_GENI_M_IRQ_EN);
 | |
| 	irq_en |= M_TX_FIFO_WATERMARK_EN | M_CMD_DONE_EN;
 | |
| 
 | |
| 	writel(DEF_TX_WM, base + SE_GENI_TX_WATERMARK_REG);
 | |
| 	writel(irq_en, base + SE_GENI_M_IRQ_EN);
 | |
| }
 | |
| 
 | |
| static void qcom_geni_serial_start_rx(struct udevice *dev)
 | |
| {
 | |
| 	u32 status;
 | |
| 	struct msm_serial_data *priv = dev_get_priv(dev);
 | |
| 
 | |
| 	status = readl(priv->base + SE_GENI_STATUS);
 | |
| 
 | |
| 	geni_se_setup_s_cmd(priv->base, UART_START_READ, 0);
 | |
| 
 | |
| 	setbits_le32(priv->base + SE_GENI_S_IRQ_EN, S_RX_FIFO_WATERMARK_EN | S_RX_FIFO_LAST_EN);
 | |
| 	setbits_le32(priv->base + SE_GENI_M_IRQ_EN, M_RX_FIFO_WATERMARK_EN | M_RX_FIFO_LAST_EN);
 | |
| }
 | |
| 
 | |
| static void qcom_geni_serial_abort_rx(struct udevice *dev)
 | |
| {
 | |
| 	struct msm_serial_data *priv = dev_get_priv(dev);
 | |
| 
 | |
| 	u32 irq_clear = S_CMD_DONE_EN | S_CMD_ABORT_EN;
 | |
| 
 | |
| 	writel(S_GENI_CMD_ABORT, priv->base + SE_GENI_S_CMD_CTRL_REG);
 | |
| 	qcom_geni_serial_poll_bit(dev, SE_GENI_S_CMD_CTRL_REG,
 | |
| 					S_GENI_CMD_ABORT, false);
 | |
| 	writel(irq_clear, priv->base + SE_GENI_S_IRQ_CLEAR);
 | |
| 	writel(FORCE_DEFAULT, priv->base + GENI_FORCE_DEFAULT_REG);
 | |
| }
 | |
| 
 | |
| static void msm_geni_serial_setup_rx(struct udevice *dev)
 | |
| {
 | |
| 	struct msm_serial_data *priv = dev_get_priv(dev);
 | |
| 
 | |
| 	qcom_geni_serial_abort_rx(dev);
 | |
| 
 | |
| 	writel(UART_PACKING_CFG0, priv->base + SE_GENI_RX_PACKING_CFG0);
 | |
| 	writel(UART_PACKING_CFG1, priv->base + SE_GENI_RX_PACKING_CFG1);
 | |
| 
 | |
| 	geni_se_setup_s_cmd(priv->base, UART_START_READ, 0);
 | |
| 
 | |
| 	setbits_le32(priv->base + SE_GENI_S_IRQ_EN, S_RX_FIFO_WATERMARK_EN | S_RX_FIFO_LAST_EN);
 | |
| 	setbits_le32(priv->base + SE_GENI_M_IRQ_EN, M_RX_FIFO_WATERMARK_EN | M_RX_FIFO_LAST_EN);
 | |
| }
 | |
| 
 | |
| static int msm_serial_putc(struct udevice *dev, const char ch)
 | |
| {
 | |
| 	struct msm_serial_data *priv = dev_get_priv(dev);
 | |
| 
 | |
| 	writel(DEF_TX_WM, priv->base + SE_GENI_TX_WATERMARK_REG);
 | |
| 	qcom_geni_serial_setup_tx(priv->base, 1);
 | |
| 
 | |
| 	qcom_geni_serial_poll_bit(dev, SE_GENI_M_IRQ_STATUS,
 | |
| 				  M_TX_FIFO_WATERMARK_EN, true);
 | |
| 
 | |
| 	writel(ch, priv->base + SE_GENI_TX_FIFOn);
 | |
| 	writel(M_TX_FIFO_WATERMARK_EN, priv->base + SE_GENI_M_IRQ_CLEAR);
 | |
| 
 | |
| 	qcom_geni_serial_poll_tx_done(dev);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int msm_serial_getc(struct udevice *dev)
 | |
| {
 | |
| 	struct msm_serial_data *priv = dev_get_priv(dev);
 | |
| 	u32 rx_fifo;
 | |
| 	u32 m_irq_status;
 | |
| 	u32 s_irq_status;
 | |
| 
 | |
| 	writel(1 << S_OPCODE_SHIFT, priv->base + SE_GENI_S_CMD0);
 | |
| 
 | |
| 	qcom_geni_serial_poll_bit(dev, SE_GENI_M_IRQ_STATUS, M_SEC_IRQ_EN,
 | |
| 				  true);
 | |
| 
 | |
| 	m_irq_status = readl(priv->base + SE_GENI_M_IRQ_STATUS);
 | |
| 	s_irq_status = readl(priv->base + SE_GENI_S_IRQ_STATUS);
 | |
| 	writel(m_irq_status, priv->base + SE_GENI_M_IRQ_CLEAR);
 | |
| 	writel(s_irq_status, priv->base + SE_GENI_S_IRQ_CLEAR);
 | |
| 	qcom_geni_serial_poll_bit(dev, SE_GENI_RX_FIFO_STATUS, RX_FIFO_WC_MSK,
 | |
| 				  true);
 | |
| 
 | |
| 	if (!readl(priv->base + SE_GENI_RX_FIFO_STATUS))
 | |
| 		return 0;
 | |
| 
 | |
| 	rx_fifo = readl(priv->base + SE_GENI_RX_FIFOn);
 | |
| 	return rx_fifo & 0xff;
 | |
| }
 | |
| 
 | |
| static int msm_serial_pending(struct udevice *dev, bool input)
 | |
| {
 | |
| 	struct msm_serial_data *priv = dev_get_priv(dev);
 | |
| 
 | |
| 	if (input)
 | |
| 		return readl(priv->base + SE_GENI_RX_FIFO_STATUS) &
 | |
| 			   RX_FIFO_WC_MSK;
 | |
| 	else
 | |
| 		return readl(priv->base + SE_GENI_TX_FIFO_STATUS) &
 | |
| 			   TX_FIFO_WC_MSK;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static const struct dm_serial_ops msm_serial_ops = {
 | |
| 	.putc = msm_serial_putc,
 | |
| 	.pending = msm_serial_pending,
 | |
| 	.getc = msm_serial_getc,
 | |
| 	.setbrg = msm_serial_setbrg,
 | |
| };
 | |
| 
 | |
| static int geni_set_oversampling(struct udevice *dev)
 | |
| {
 | |
| 	struct msm_serial_data *priv = dev_get_priv(dev);
 | |
| 	ofnode parent_node = ofnode_get_parent(dev_ofnode(dev));
 | |
| 	u32 geni_se_version;
 | |
| 	fdt_addr_t addr;
 | |
| 
 | |
| 	priv->oversampling = UART_OVERSAMPLING;
 | |
| 
 | |
| 	/*
 | |
| 	 * It could happen that GENI SE IP is missing in the board's device
 | |
| 	 * tree or GENI UART node is a direct child of SoC device tree node.
 | |
| 	 */
 | |
| 	if (!ofnode_device_is_compatible(parent_node, "qcom,geni-se-qup")) {
 | |
| 		pr_err("%s: UART node must be a child of geniqup node\n",
 | |
| 		       __func__);
 | |
| 		return -ENODEV;
 | |
| 	}
 | |
| 
 | |
| 	/* Read the HW_VER register relative to the parents address space */
 | |
| 	addr = ofnode_get_addr(parent_node);
 | |
| 	geni_se_version = readl(addr + QUP_HW_VER_REG);
 | |
| 
 | |
| 	if (geni_se_version >= QUP_SE_VERSION_2_5)
 | |
| 		priv->oversampling /= 2;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static inline void geni_serial_init(struct udevice *dev)
 | |
| {
 | |
| 	struct msm_serial_data *priv = dev_get_priv(dev);
 | |
| 	phys_addr_t base_address = priv->base;
 | |
| 	u32 tx_trans_cfg;
 | |
| 	u32 tx_parity_cfg = 0; /* Disable Tx Parity */
 | |
| 	u32 rx_trans_cfg = 0;
 | |
| 	u32 rx_parity_cfg = 0; /* Disable Rx Parity */
 | |
| 	u32 stop_bit_len = 0;  /* Default stop bit length - 1 bit */
 | |
| 	u32 bits_per_char;
 | |
| 
 | |
| 	/*
 | |
| 	 * Ignore Flow control.
 | |
| 	 * n = 8.
 | |
| 	 */
 | |
| 	tx_trans_cfg = UART_CTS_MASK;
 | |
| 	bits_per_char = BITS_PER_BYTE;
 | |
| 
 | |
| 	/*
 | |
| 	 * Make an unconditional cancel on the main sequencer to reset
 | |
| 	 * it else we could end up in data loss scenarios.
 | |
| 	 */
 | |
| 	qcom_geni_serial_poll_tx_done(dev);
 | |
| 	qcom_geni_serial_abort_rx(dev);
 | |
| 
 | |
| 	writel(UART_PACKING_CFG0, base_address + SE_GENI_TX_PACKING_CFG0);
 | |
| 	writel(UART_PACKING_CFG1, base_address + SE_GENI_TX_PACKING_CFG1);
 | |
| 	writel(UART_PACKING_CFG0, base_address + SE_GENI_RX_PACKING_CFG0);
 | |
| 	writel(UART_PACKING_CFG1, base_address + SE_GENI_RX_PACKING_CFG1);
 | |
| 
 | |
| 	writel(tx_trans_cfg, base_address + SE_UART_TX_TRANS_CFG);
 | |
| 	writel(tx_parity_cfg, base_address + SE_UART_TX_PARITY_CFG);
 | |
| 	writel(rx_trans_cfg, base_address + SE_UART_RX_TRANS_CFG);
 | |
| 	writel(rx_parity_cfg, base_address + SE_UART_RX_PARITY_CFG);
 | |
| 	writel(bits_per_char, base_address + SE_UART_TX_WORD_LEN);
 | |
| 	writel(bits_per_char, base_address + SE_UART_RX_WORD_LEN);
 | |
| 	writel(stop_bit_len, base_address + SE_UART_TX_STOP_BIT_LEN);
 | |
| }
 | |
| 
 | |
| static int msm_serial_probe(struct udevice *dev)
 | |
| {
 | |
| 	struct msm_serial_data *priv = dev_get_priv(dev);
 | |
| 	int ret;
 | |
| 
 | |
| 	ret = geni_set_oversampling(dev);
 | |
| 	if (ret < 0)
 | |
| 		return ret;
 | |
| 
 | |
| 	/* No need to reinitialize the UART after relocation */
 | |
| 	if (gd->flags & GD_FLG_RELOC)
 | |
| 		return 0;
 | |
| 
 | |
| 	geni_serial_init(dev);
 | |
| 	msm_geni_serial_setup_rx(dev);
 | |
| 	qcom_geni_serial_start_rx(dev);
 | |
| 	qcom_geni_serial_start_tx(priv->base);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int msm_serial_ofdata_to_platdata(struct udevice *dev)
 | |
| {
 | |
| 	struct msm_serial_data *priv = dev_get_priv(dev);
 | |
| 
 | |
| 	priv->base = dev_read_addr(dev);
 | |
| 	if (priv->base == FDT_ADDR_T_NONE)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static const struct udevice_id msm_serial_ids[] = {
 | |
| 	{ .compatible = "qcom,geni-debug-uart" },
 | |
| 	{ }
 | |
| };
 | |
| 
 | |
| U_BOOT_DRIVER(serial_msm_geni) = {
 | |
| 	.name = "serial_msm_geni",
 | |
| 	.id = UCLASS_SERIAL,
 | |
| 	.of_match = msm_serial_ids,
 | |
| 	.of_to_plat = msm_serial_ofdata_to_platdata,
 | |
| 	.priv_auto = sizeof(struct msm_serial_data),
 | |
| 	.probe = msm_serial_probe,
 | |
| 	.ops = &msm_serial_ops,
 | |
| 	.flags = DM_FLAG_PRE_RELOC | DM_FLAG_DEFAULT_PD_CTRL_OFF,
 | |
| };
 | |
| 
 | |
| static const struct udevice_id geniqup_ids[] = {
 | |
| 	{ .compatible = "qcom,geni-se-qup" },
 | |
| 	{ }
 | |
| };
 | |
| 
 | |
| U_BOOT_DRIVER(geni_se_qup) = {
 | |
| 	.name = "geni-se-qup",
 | |
| 	.id = UCLASS_NOP,
 | |
| 	.of_match = geniqup_ids,
 | |
| 	.bind = dm_scan_fdt_dev,
 | |
| 	.flags = DM_FLAG_PRE_RELOC | DM_FLAG_DEFAULT_PD_CTRL_OFF,
 | |
| };
 | |
| 
 | |
| #ifdef CONFIG_DEBUG_UART_MSM_GENI
 | |
| 
 | |
| static struct msm_serial_data init_serial_data = {
 | |
| 	.base = CONFIG_VAL(DEBUG_UART_BASE)
 | |
| };
 | |
| 
 | |
| /* Serial dumb device, to reuse driver code */
 | |
| static struct udevice init_dev = {
 | |
| 	.priv_ = &init_serial_data,
 | |
| };
 | |
| 
 | |
| #include <debug_uart.h>
 | |
| 
 | |
| #define CLK_DIV (CONFIG_DEBUG_UART_CLOCK / \
 | |
| 					(CONFIG_BAUDRATE * UART_OVERSAMPLING))
 | |
| #if (CONFIG_DEBUG_UART_CLOCK % (CONFIG_BAUDRATE * UART_OVERSAMPLING) > 0)
 | |
| #error Clocks cannot be set at early debug. Change CONFIG_BAUDRATE
 | |
| #endif
 | |
| 
 | |
| static inline void _debug_uart_init(void)
 | |
| {
 | |
| 	phys_addr_t base = CONFIG_VAL(DEBUG_UART_BASE);
 | |
| 
 | |
| 	geni_serial_init(&init_dev);
 | |
| 	geni_serial_baud(base, CLK_DIV, CONFIG_BAUDRATE);
 | |
| 	qcom_geni_serial_start_tx(base);
 | |
| }
 | |
| 
 | |
| static inline void _debug_uart_putc(int ch)
 | |
| {
 | |
| 	phys_addr_t base = CONFIG_VAL(DEBUG_UART_BASE);
 | |
| 
 | |
| 	writel(DEF_TX_WM, base + SE_GENI_TX_WATERMARK_REG);
 | |
| 	qcom_geni_serial_setup_tx(base, 1);
 | |
| 	qcom_geni_serial_poll_bit(&init_dev, SE_GENI_M_IRQ_STATUS,
 | |
| 				  M_TX_FIFO_WATERMARK_EN, true);
 | |
| 
 | |
| 	writel(ch, base + SE_GENI_TX_FIFOn);
 | |
| 	writel(M_TX_FIFO_WATERMARK_EN, base + SE_GENI_M_IRQ_CLEAR);
 | |
| 	qcom_geni_serial_poll_tx_done(&init_dev);
 | |
| }
 | |
| 
 | |
| DEBUG_UART_FUNCS
 | |
| 
 | |
| #endif
 |