1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * i.MX8QXP/i.MX8QM JPEG encoder/decoder v4l2 driver 4 * 5 * Copyright 2018-2019 NXP 6 */ 7 8 #include <linux/delay.h> 9 #include <media/videobuf2-core.h> 10 #include "mxc-jpeg-hw.h" 11 12 #define print_wrapper_reg(dev, base_address, reg_offset)\ 13 internal_print_wrapper_reg(dev, (base_address), #reg_offset,\ 14 (reg_offset)) 15 #define internal_print_wrapper_reg(dev, base_address, reg_name, reg_offset) {\ 16 int val;\ 17 val = readl((base_address) + (reg_offset));\ 18 dev_dbg(dev, "Wrapper reg %s = 0x%x\n", reg_name, val);\ 19 } 20 21 void print_descriptor_info(struct device *dev, struct mxc_jpeg_desc *desc) 22 { 23 dev_dbg(dev, " MXC JPEG NEXT_DESCPT_PTR 0x%x\n", 24 desc->next_descpt_ptr); 25 dev_dbg(dev, " MXC JPEG BUF_BASE0 0x%x\n", desc->buf_base0); 26 dev_dbg(dev, " MXC JPEG BUF_BASE1 0x%x\n", desc->buf_base1); 27 dev_dbg(dev, " MXC JPEG LINE_PITCH %d\n", desc->line_pitch); 28 dev_dbg(dev, " MXC JPEG STM_BUFBASE 0x%x\n", desc->stm_bufbase); 29 dev_dbg(dev, " MXC JPEG STM_BUFSIZE %d\n", desc->stm_bufsize); 30 dev_dbg(dev, " MXC JPEG IMGSIZE %x (%d x %d)\n", desc->imgsize, 31 desc->imgsize >> 16, desc->imgsize & 0xFFFF); 32 dev_dbg(dev, " MXC JPEG STM_CTRL 0x%x\n", desc->stm_ctrl); 33 } 34 35 void print_cast_status(struct device *dev, void __iomem *reg, 36 unsigned int mode) 37 { 38 dev_dbg(dev, "CAST IP status regs:\n"); 39 print_wrapper_reg(dev, reg, CAST_STATUS0); 40 print_wrapper_reg(dev, reg, CAST_STATUS1); 41 print_wrapper_reg(dev, reg, CAST_STATUS2); 42 print_wrapper_reg(dev, reg, CAST_STATUS3); 43 print_wrapper_reg(dev, reg, CAST_STATUS4); 44 print_wrapper_reg(dev, reg, CAST_STATUS5); 45 print_wrapper_reg(dev, reg, CAST_STATUS6); 46 print_wrapper_reg(dev, reg, CAST_STATUS7); 47 print_wrapper_reg(dev, reg, CAST_STATUS8); 48 print_wrapper_reg(dev, reg, CAST_STATUS9); 49 print_wrapper_reg(dev, reg, CAST_STATUS10); 50 print_wrapper_reg(dev, reg, CAST_STATUS11); 51 print_wrapper_reg(dev, reg, CAST_STATUS12); 52 print_wrapper_reg(dev, reg, CAST_STATUS13); 53 if (mode == MXC_JPEG_DECODE) 54 return; 55 print_wrapper_reg(dev, reg, CAST_STATUS14); 56 print_wrapper_reg(dev, reg, CAST_STATUS15); 57 print_wrapper_reg(dev, reg, CAST_STATUS16); 58 print_wrapper_reg(dev, reg, CAST_STATUS17); 59 print_wrapper_reg(dev, reg, CAST_STATUS18); 60 print_wrapper_reg(dev, reg, CAST_STATUS19); 61 } 62 63 void print_wrapper_info(struct device *dev, void __iomem *reg) 64 { 65 dev_dbg(dev, "Wrapper regs:\n"); 66 print_wrapper_reg(dev, reg, GLB_CTRL); 67 print_wrapper_reg(dev, reg, COM_STATUS); 68 print_wrapper_reg(dev, reg, BUF_BASE0); 69 print_wrapper_reg(dev, reg, BUF_BASE1); 70 print_wrapper_reg(dev, reg, LINE_PITCH); 71 print_wrapper_reg(dev, reg, STM_BUFBASE); 72 print_wrapper_reg(dev, reg, STM_BUFSIZE); 73 print_wrapper_reg(dev, reg, IMGSIZE); 74 print_wrapper_reg(dev, reg, STM_CTRL); 75 } 76 77 void mxc_jpeg_enable_irq(void __iomem *reg, int slot) 78 { 79 writel(0xFFFFFFFF, reg + MXC_SLOT_OFFSET(slot, SLOT_STATUS)); 80 writel(0xF0C, reg + MXC_SLOT_OFFSET(slot, SLOT_IRQ_EN)); 81 } 82 83 void mxc_jpeg_disable_irq(void __iomem *reg, int slot) 84 { 85 writel(0x0, reg + MXC_SLOT_OFFSET(slot, SLOT_IRQ_EN)); 86 writel(0xFFFFFFFF, reg + MXC_SLOT_OFFSET(slot, SLOT_STATUS)); 87 } 88 89 void mxc_jpeg_sw_reset(void __iomem *reg) 90 { 91 /* 92 * engine soft reset, internal state machine reset 93 * this will not reset registers, however, it seems 94 * the registers may remain inconsistent with the internal state 95 * so, on purpose, at least let GLB_CTRL bits clear after this reset 96 */ 97 writel(GLB_CTRL_SFT_RST, reg + GLB_CTRL); 98 } 99 100 void mxc_jpeg_enc_mode_conf(struct device *dev, void __iomem *reg) 101 { 102 dev_dbg(dev, "CAST Encoder CONFIG...\n"); 103 /* 104 * "Config_Mode" enabled, "Config_Mode auto clear enabled", 105 */ 106 writel(0xa0, reg + CAST_MODE); 107 108 /* all markers and segments */ 109 writel(0x3ff, reg + CAST_CFG_MODE); 110 } 111 112 void mxc_jpeg_enc_mode_go(struct device *dev, void __iomem *reg) 113 { 114 dev_dbg(dev, "CAST Encoder GO...\n"); 115 /* 116 * "GO" enabled, "GO bit auto clear" enabled 117 */ 118 writel(0x140, reg + CAST_MODE); 119 } 120 121 void mxc_jpeg_enc_set_quality(struct device *dev, void __iomem *reg, u8 quality) 122 { 123 dev_dbg(dev, "CAST Encoder Quality %d...\n", quality); 124 125 /* quality factor */ 126 writel(quality, reg + CAST_QUALITY); 127 } 128 129 void mxc_jpeg_dec_mode_go(struct device *dev, void __iomem *reg) 130 { 131 dev_dbg(dev, "CAST Decoder GO...\n"); 132 writel(MXC_DEC_EXIT_IDLE_MODE, reg + CAST_CTRL); 133 } 134 135 int mxc_jpeg_enable(void __iomem *reg) 136 { 137 u32 regval; 138 139 writel(GLB_CTRL_JPG_EN, reg + GLB_CTRL); 140 regval = readl(reg); 141 return regval; 142 } 143 144 void mxc_jpeg_enable_slot(void __iomem *reg, int slot) 145 { 146 u32 regval; 147 148 regval = readl(reg + GLB_CTRL); 149 writel(GLB_CTRL_SLOT_EN(slot) | regval, reg + GLB_CTRL); 150 } 151 152 void mxc_jpeg_set_l_endian(void __iomem *reg, int le) 153 { 154 u32 regval; 155 156 regval = readl(reg + GLB_CTRL); 157 regval &= ~GLB_CTRL_L_ENDIAN(1); /* clear */ 158 writel(GLB_CTRL_L_ENDIAN(le) | regval, reg + GLB_CTRL); /* set */ 159 } 160 161 void mxc_jpeg_set_bufsize(struct mxc_jpeg_desc *desc, u32 bufsize) 162 { 163 desc->stm_bufsize = bufsize; 164 } 165 166 void mxc_jpeg_set_res(struct mxc_jpeg_desc *desc, u16 w, u16 h) 167 { 168 desc->imgsize = w << 16 | h; 169 } 170 171 void mxc_jpeg_set_line_pitch(struct mxc_jpeg_desc *desc, u32 line_pitch) 172 { 173 desc->line_pitch = line_pitch; 174 } 175 176 void mxc_jpeg_set_desc(u32 desc, void __iomem *reg, int slot) 177 { 178 writel(desc | MXC_NXT_DESCPT_EN, 179 reg + MXC_SLOT_OFFSET(slot, SLOT_NXT_DESCPT_PTR)); 180 } 181