For the Part 4 problem, I solved it by setting the PIXEL BIT
I set SENSOR_16BITS, but the final result didn't change .
- Note that I received the correct data on csi RXFIFO, while I added some print information to the mx6s_csi_frame_done function and it showed the correct result, but ended up with the wrong data on the application layer.
static void mx6s_csi_frame_done(struct mx6s_csi_dev *csi_dev,
int bufnum, bool err)
{
struct mx6s_buf_internal *ibuf;
struct mx6s_buffer *buf;
struct vb2_buffer *vb;
unsigned long phys;
unsigned int phys_fb1;
unsigned int phys_fb2;
uint8_t *pmen;
ibuf = list_first_entry(&csi_dev->active_bufs, struct mx6s_buf_internal,
queue);
if (ibuf->discard) {
/*
* Discard buffer must not be returned to user space.
* Just return it to the discard queue.
*/
list_move_tail(csi_dev->active_bufs.next, &csi_dev->discard);
} else {
buf = mx6s_ibuf_to_buf(ibuf);
vb = &buf->vb.vb2_buf;
phys = vb2_dma_contig_plane_dma_addr(vb, 0);
if (bufnum == 1) {
phys_fb2 = csi_read(csi_dev, CSI_CSIDMASA_FB2);
if (phys_fb2 != (u32)phys) {
dev_err(csi_dev->dev, "%lx != %x\n", phys,
phys_fb2);
}
} else {
phys_fb1 = csi_read(csi_dev, CSI_CSIDMASA_FB1);
if (phys_fb1 != (u32)phys) {
dev_err(csi_dev->dev, "%lx != %x\n", phys,
phys_fb1);
}
}
dev_dbg(csi_dev->dev, "%s (vb=0x%p) 0x%p %lu\n", __func__, vb,
vb2_plane_vaddr(vb, 0),
vb2_get_plane_payload(vb, 0));
pmen=vb2_plane_vaddr(vb, 0);
dev_dbg(csi_dev->dev, "addr=0x%p 0x%08x\n",pmen ,__raw_readl(pmen));
dev_dbg(csi_dev->dev, "phys1 addr=0x%p \n",phys);
list_del_init(&buf->internal.queue);
vb->timestamp =ktime_get_ns();
to_vb2_v4l2_buffer(vb)->sequence = csi_dev->frame_count;
if (err)
vb2_buffer_done(vb, VB2_BUF_STATE_ERROR);
else
vb2_buffer_done(vb, VB2_BUF_STATE_DONE);
}
csi_dev->frame_count++;
csi_dev->nextfb = (bufnum == 0 ? 1 : 0);
/* Config discard buffer to active_bufs */
if (list_empty(&csi_dev->capture)) {
if (list_empty(&csi_dev->discard)) {
dev_warn(csi_dev->dev,
"%s: trying to access empty discard list\n",
__func__);
return;
}
ibuf = list_first_entry(&csi_dev->discard,
struct mx6s_buf_internal, queue);
ibuf->bufnum = bufnum;
list_move_tail(csi_dev->discard.next, &csi_dev->active_bufs);
mx6s_update_csi_buf(csi_dev,
csi_dev->discard_buffer_dma, bufnum);
return;
}
buf = list_first_entry(&csi_dev->capture, struct mx6s_buffer,
internal.queue);
buf->internal.bufnum = bufnum;
list_move_tail(csi_dev->capture.next, &csi_dev->active_bufs);
vb = &buf->vb.vb2_buf;
vb->state = VB2_BUF_STATE_ACTIVE;
phys = vb2_dma_contig_plane_dma_addr(vb, 0);
mx6s_update_csi_buf(csi_dev, phys, bufnum);
}
At the same time I did some other checks that the data received at the application layer was correct when the tof sensor was in test mode (the transmission data was fixed). However, if it is switched to the normal mode, there will be anomalies in the data received at the application layer. Specific anomalies are as I described before. I think the possibility of error of tof sensor can be eliminated, because the data received in RXFIFO is correct. I initially thought there might be a problem with synchronization after the DMA transfer, but now I can't figure out the reason. I hope you can give us a good method.
