hdmirx: for dump tmds data [1/1]

PD#SWPL-2931

Problem:
1.verify dump tmds data

Solution:
1.modify function and verify on tl1

Verify:
tl1

Change-Id: I36e922ba44f4f8c5201c9fb0869d65556a6e28c7
Signed-off-by: Yong Qin <yong.qin@amlogic.com>

diff --git a/drivers/amlogic/media/vin/tvin/hdmirx/hdmi_rx_drv.c b/drivers/amlogic/media/vin/tvin/hdmirx/hdmi_rx_drv.c
index 9d319fd..47ff362 100644 (file)
--- a/drivers/amlogic/media/vin/tvin/hdmirx/hdmi_rx_drv.c
+++ b/drivers/amlogic/media/vin/tvin/hdmirx/hdmi_rx_drv.c
@@ -1756,17 +1756,26 @@ void rx_emp_resource_allocate(struct device *dev)
 
 void rx_tmds_resource_allocate(struct device *dev)
 {
+       /*uint32_t *src_v_addr;*/
+       /*uint32_t *temp;*/
+       /*uint32_t i, j;*/
+       /*phys_addr_t p_addr;*/
+       /*struct page *pg_addr;*/
+
        if (rx.hdmirxdev->data->chip_id == CHIP_ID_TL1) {
                if (rx.empbuff.dump_mode == DUMP_MODE_EMP) {
                        if (rx.empbuff.pg_addr) {
                                dma_release_from_contiguous(dev,
                                                rx.empbuff.pg_addr,
                                                EMP_BUFFER_SIZE >> PAGE_SHIFT);
+                               /*free_reserved_area();*/
                                rx.empbuff.pg_addr = 0;
                                rx_pr("release emp data buffer\n");
                        }
                } else {
-                       dma_release_from_contiguous(dev, rx.empbuff.pg_addr,
+                       if (rx.empbuff.pg_addr)
+                               dma_release_from_contiguous(dev,
+                                       rx.empbuff.pg_addr,
                                        TMDS_BUFFER_SIZE >> PAGE_SHIFT);
                        rx.empbuff.pg_addr = 0;
                        rx_pr("release pre tmds data buffer\n");
@@ -1776,6 +1785,7 @@ void rx_tmds_resource_allocate(struct device *dev)
                rx.empbuff.pg_addr =
                                dma_alloc_from_contiguous(dev,
                                        TMDS_BUFFER_SIZE >> PAGE_SHIFT, 0);
+
                if (rx.empbuff.pg_addr)
                        rx.empbuff.p_addr_a =
                                page_to_phys(rx.empbuff.pg_addr);
@@ -1783,6 +1793,27 @@ void rx_tmds_resource_allocate(struct device *dev)
                        rx_pr("allocate tmds data buff fail\n");
                rx.empbuff.dump_mode = DUMP_MODE_TMDS;
                rx_pr("buffa paddr=0x%x\n", rx.empbuff.p_addr_a);
+               #if 0
+               /*clear buffer for test*/
+               for (i = 0; i < 10; i++) {
+                       p_addr = rx.empbuff.p_addr_a + i*PAGE_SIZE;
+                       pg_addr = phys_to_page(p_addr);
+                       dma_sync_single_for_device(hdmirx_dev,
+                               p_addr, PAGE_SIZE, DMA_TO_DEVICE);
+                       src_v_addr = kmap(pg_addr);
+                       /*rx_pr("i:%d,p=0x%x v=0x%x ", i, p_addr, src_v_addr);*/
+                       temp = src_v_addr;
+                       for (j = 0; j < PAGE_SIZE; ) {
+                               *temp = 0x5a010a30 + i;
+                               temp++;
+                               j += 4;
+                               /*rx_pr("%d ", j);*/
+                       }
+                       flush_kernel_dcache_page(pg_addr);
+                       kunmap(pg_addr);
+                       /*rx_pr("page end\n");*/
+               }
+               #endif
        }
 }
 
@@ -1830,10 +1861,14 @@ void rx_tmds_data_capture(void)
        loff_t pos = 0;
        char *path = "/data/tmds_data.bin";
        unsigned int offset = 0;
-       unsigned char *src_v_addr;
+       char *src_v_addr;
        mm_segment_t old_fs = get_fs();
-       unsigned int recv_pagenum, i;
+       unsigned int recv_pagenum = 0, i, j;
        unsigned int recv_byte_cnt;
+       struct page *pg_addr;
+       phys_addr_t p_addr;
+       char *tmpbuff;
+       unsigned int *paddr;
 
        set_fs(KERNEL_DS);
        filp = filp_open(path, O_RDWR|O_CREAT, 0666);
@@ -1843,26 +1878,60 @@ void rx_tmds_data_capture(void)
                return;
        }
 
-       recv_byte_cnt = rx.empbuff.tmdspktcnt * 4;
+       tmpbuff = kmalloc(PAGE_SIZE + 16, GFP_KERNEL);
+       if (!tmpbuff) {
+               rx_pr("tmds malloc buffer err\n");
+               return;
+       }
+       memset(tmpbuff, 0, PAGE_SIZE);
+       recv_byte_cnt = rx.empbuff.tmdspktcnt*4;
        recv_pagenum = (recv_byte_cnt >> PAGE_SHIFT) + 1;
+
        rx_pr("total byte:%d page:%d\n", recv_byte_cnt, recv_pagenum);
        for (i = 0; i < recv_pagenum; i++) {
                /* one page 4k,tmds data physical address, need map v addr */
-               src_v_addr = kmap(rx.empbuff.pg_addr + i);
+               p_addr = rx.empbuff.p_addr_a + i*PAGE_SIZE;
+               pg_addr = phys_to_page(p_addr);
+               src_v_addr = kmap(pg_addr);
+               dma_sync_single_for_cpu(hdmirx_dev,
+                       p_addr, PAGE_SIZE, DMA_TO_DEVICE);
+               pos = i * PAGE_SIZE;
                if (recv_byte_cnt >= PAGE_SIZE) {
                        offset = PAGE_SIZE;
-                       vfs_write(filp, src_v_addr, offset, &pos);
+                       memcpy(tmpbuff, src_v_addr, PAGE_SIZE);
+                       vfs_write(filp, tmpbuff, offset, &pos);
                        recv_byte_cnt -= PAGE_SIZE;
                } else {
                        offset = recv_byte_cnt;
-                       vfs_write(filp, src_v_addr, offset, &pos);
+                       memcpy(tmpbuff, src_v_addr, recv_byte_cnt);
+                       vfs_write(filp, tmpbuff, offset, &pos);
+                       recv_byte_cnt = 0;
+               }
+
+               /* release current page */
+               kunmap(pg_addr);
+       }
+
+       /* for teset */
+       for (i = 0; i < recv_pagenum; i++) {
+               p_addr = rx.empbuff.p_addr_a + i*PAGE_SIZE;
+               pg_addr = phys_to_page(p_addr);
+               /* p addr map to v addr*/
+               paddr = kmap(pg_addr);
+               for (j = 0; j < PAGE_SIZE;) {
+                       *paddr = 0xaabbccdd;
+                       paddr++;
+                       j += 4;
                }
+               rx_pr(".");
+               dma_sync_single_for_device(hdmirx_dev,
+                       p_addr, PAGE_SIZE, DMA_TO_DEVICE);
                /* release current page */
-               kunmap(rx.empbuff.pg_addr + i);
-               rx_pr("%d ", i);
+               kunmap(pg_addr);
        }
-       rx_pr("write from 0x%x to 0x%x to %s\n",
-                       pos, offset, path);
+
+       kfree(tmpbuff);
+       rx_pr("write to %s\n", path);
        vfs_fsync(filp, 0);
        filp_close(filp, NULL);
        set_fs(old_fs);

diff --git a/drivers/amlogic/media/vin/tvin/hdmirx/hdmi_rx_drv.h b/drivers/amlogic/media/vin/tvin/hdmirx/hdmi_rx_drv.h
index df52f3c..aa1292e 100644 (file)
--- a/drivers/amlogic/media/vin/tvin/hdmirx/hdmi_rx_drv.h
+++ b/drivers/amlogic/media/vin/tvin/hdmirx/hdmi_rx_drv.h
@@ -34,7 +34,7 @@
 #include "hdmi_rx_edid.h"
 
 
-#define RX_VER0 "ver.2018-11-28"
+#define RX_VER0 "ver.2018-11-30"
 /*
  *
  *

diff --git a/drivers/amlogic/media/vin/tvin/hdmirx/hdmi_rx_hw.c b/drivers/amlogic/media/vin/tvin/hdmirx/hdmi_rx_hw.c
index 5d9dfdd..44659e8 100644 (file)
--- a/drivers/amlogic/media/vin/tvin/hdmirx/hdmi_rx_hw.c
+++ b/drivers/amlogic/media/vin/tvin/hdmirx/hdmi_rx_hw.c
@@ -3665,7 +3665,6 @@ void rx_emp_field_done_irq(void)
 
        /*emp data start physical address*/
        p_addr = hdmirx_rd_top(TOP_EMP_DDR_PTR_S_BUF);
-       cur_start_pg_addr = phys_to_page(p_addr);
 
        /*buffer number*/
        recv_pkt_cnt = hdmirx_rd_top(TOP_EMP_RCV_CNT_BUF);
@@ -3684,7 +3683,10 @@ void rx_emp_field_done_irq(void)
 
        for (i = 0; i < recv_pagenum;) {
                /*one page 4k*/
-               src_addr = kmap_atomic(cur_start_pg_addr + i);
+               cur_start_pg_addr = phys_to_page(p_addr + i*PAGE_SIZE);
+               src_addr = kmap_atomic(cur_start_pg_addr);
+               dma_sync_single_for_cpu(hdmirx_dev, (p_addr + i*PAGE_SIZE),
+                       PAGE_SIZE, DMA_TO_DEVICE);
                if (recv_byte_cnt >= PAGE_SIZE) {
                        for (j = 0; j < PAGE_SIZE;) {
                                if (src_addr[j] == 0x7f) {
@@ -3714,7 +3716,8 @@ void rx_emp_field_done_irq(void)
                        }
                }
                /*release*/
-               __kunmap_atomic(src_addr);
+               /*__kunmap_atomic(src_addr);*/
+               kunmap_atomic(src_addr);
                i++;
        }
 
@@ -3776,6 +3779,7 @@ void rx_tmds_to_ddr_init(void)
                                rx.empbuff.p_addr_a);
                        hdmirx_wr_top(TOP_EMP_DDR_START_B,
                                rx.empbuff.p_addr_a);
+                       rx_pr("cfg hw addr=0x%x\n", rx.empbuff.p_addr_a);
                }
 
                /* max pkt count to avoid buffer overflow */
@@ -3785,8 +3789,8 @@ void rx_tmds_to_ddr_init(void)
                rx_pr("pkt max cnt limit=0x%x\n", data);
 
                data = 0;
-               data |= 0xf << 16;/*[23:16] hs_beat_rate=0xf */
-               /*[14] buffer_info_mode=0 */
+               data |= 0x0 << 16;/*[23:16] hs_beat_rate=0xf */
+               data |= 0x1 << 14;/*[14] buffer_info_mode=0 */
                data |= 0x1 << 13;/*[13] reset_on_de=1 */
                data |= 0x0 << 12;/*[12] burst_end_on_last_emp=1 */
                data |= 0x0 << 2;/*[11:2] de_rise_delay=0 */