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_IRQ_EN)); 80 } 81 82 void mxc_jpeg_disable_irq(void __iomem *reg, int slot) 83 { 84 writel(0x0, reg + MXC_SLOT_OFFSET(slot, SLOT_IRQ_EN)); 85 } 86 87 void mxc_jpeg_sw_reset(void __iomem *reg) 88 { 89 /* 90 * engine soft reset, internal state machine reset 91 * this will not reset registers, however, it seems 92 * the registers may remain inconsistent with the internal state 93 * so, on purpose, at least let GLB_CTRL bits clear after this reset 94 */ 95 writel(GLB_CTRL_SFT_RST, reg + GLB_CTRL); 96 } 97 98 void mxc_jpeg_enc_mode_conf(struct device *dev, void __iomem *reg) 99 { 100 dev_dbg(dev, "CAST Encoder CONFIG...\n"); 101 /* 102 * "Config_Mode" enabled, "Config_Mode auto clear enabled", 103 */ 104 writel(0xa0, reg + CAST_MODE); 105 106 /* all markers and segments */ 107 writel(0x3ff, reg + CAST_CFG_MODE); 108 } 109 110 void mxc_jpeg_enc_mode_go(struct device *dev, void __iomem *reg) 111 { 112 dev_dbg(dev, "CAST Encoder GO...\n"); 113 /* 114 * "GO" enabled, "GO bit auto clear" enabled 115 */ 116 writel(0x140, reg + CAST_MODE); 117 } 118 119 void mxc_jpeg_enc_set_quality(struct device *dev, void __iomem *reg, u8 quality) 120 { 121 dev_dbg(dev, "CAST Encoder Quality %d...\n", quality); 122 123 /* quality factor */ 124 writel(quality, reg + CAST_QUALITY); 125 } 126 127 void mxc_jpeg_dec_mode_go(struct device *dev, void __iomem *reg) 128 { 129 dev_dbg(dev, "CAST Decoder GO...\n"); 130 writel(MXC_DEC_EXIT_IDLE_MODE, reg + CAST_CTRL); 131 } 132 133 int mxc_jpeg_enable(void __iomem *reg) 134 { 135 u32 regval; 136 137 writel(GLB_CTRL_JPG_EN, reg + GLB_CTRL); 138 regval = readl(reg); 139 return regval; 140 } 141 142 void mxc_jpeg_enable_slot(void __iomem *reg, int slot) 143 { 144 u32 regval; 145 146 regval = readl(reg + GLB_CTRL); 147 writel(GLB_CTRL_SLOT_EN(slot) | regval, reg + GLB_CTRL); 148 } 149 150 void mxc_jpeg_set_l_endian(void __iomem *reg, int le) 151 { 152 u32 regval; 153 154 regval = readl(reg + GLB_CTRL); 155 regval &= ~GLB_CTRL_L_ENDIAN(1); /* clear */ 156 writel(GLB_CTRL_L_ENDIAN(le) | regval, reg + GLB_CTRL); /* set */ 157 } 158 159 void mxc_jpeg_set_bufsize(struct mxc_jpeg_desc *desc, u32 bufsize) 160 { 161 desc->stm_bufsize = bufsize; 162 } 163 164 void mxc_jpeg_set_res(struct mxc_jpeg_desc *desc, u16 w, u16 h) 165 { 166 desc->imgsize = w << 16 | h; 167 } 168 169 void mxc_jpeg_set_line_pitch(struct mxc_jpeg_desc *desc, u32 line_pitch) 170 { 171 desc->line_pitch = line_pitch; 172 } 173 174 void mxc_jpeg_set_desc(u32 desc, void __iomem *reg, int slot) 175 { 176 writel(desc | MXC_NXT_DESCPT_EN, 177 reg + MXC_SLOT_OFFSET(slot, SLOT_NXT_DESCPT_PTR)); 178 } 179