From 05e0e902817d60ddb12eb3ff5ea68a74c13bb8a9 Mon Sep 17 00:00:00 2001
From: michael_shih <michael_shih@edge-core.com>
Date: Mon, 6 Mar 2023 16:31:05 +0800
Subject: [PATCH] [Edgecore][device][platform] Filter fpga error message when
 user manual removal xcvr

Signed-off-by: michael_shih <michael_shih@edge-core.com>
---
 .../modules/accton_as9736_64d_fpga.c          | 36 +++++++++++++++++++
 1 file changed, 36 insertions(+)

diff --git a/platform/broadcom/sonic-platform-modules-accton/as9736-64d/modules/accton_as9736_64d_fpga.c b/platform/broadcom/sonic-platform-modules-accton/as9736-64d/modules/accton_as9736_64d_fpga.c
index a51d13767a0f..4c5358a41195 100755
--- a/platform/broadcom/sonic-platform-modules-accton/as9736-64d/modules/accton_as9736_64d_fpga.c
+++ b/platform/broadcom/sonic-platform-modules-accton/as9736-64d/modules/accton_as9736_64d_fpga.c
@@ -147,6 +147,9 @@
 #define PCIE_FPGA_I2C_CONTROL_RTC0_CONFIG_0       0x2050
 #define PCIE_FPGA_I2C_CONTROL_RTC0_CONFIG_1       0x2054
 #define PCIE_FPGA_I2C_CONTROL_RTC0_STATUS_0       0x2060
+    #define RTC0_STATUS_0_DONE                    0x1
+    #define RTC0_STATUS_0_ERROR                   0x2
+    #define RTC0_STATUS_0_BUSY                    0x4
 
 /* I2C RTC Data Block */
 #define PCIE_FPGA_I2C_RTC_WRITE_DATA_REG_0        0x5000
@@ -1779,6 +1782,27 @@ static int get_port_present_status(struct bin_attribute *attr)
     return present;
 }
 
+static int get_filter_unpresent_case(struct bin_attribute *attr)
+{
+    int present = 0;
+    int err_cnt = 0;
+
+    while(err_cnt < 2)
+    {
+        msleep(400);   /*delay 0.4 second*/
+        present = get_port_present_status(attr);
+
+        if(present) {
+            err_cnt++;
+            continue;
+        } else {       /*unpresent*/
+            return 1;
+        }
+    }
+
+    return 0;
+}
+
 static ssize_t
 sfp_eeprom_read(struct file *filp, struct kobject *kobj,
              struct bin_attribute *attr,
@@ -1871,6 +1895,10 @@ sfp_eeprom_read(struct file *filp, struct kobject *kobj,
     return count;
 
 exit_err:
+    if( (state == RTC0_STATUS_0_ERROR) &&
+        (get_filter_unpresent_case(attr)) ) { /*Filter xcvr unplug error case*/
+        return -ENXIO;
+    }
     pcie_err("%s ERROR(%d): Port%d pcie get done status failed!!", show_date_time(), state, pdata->port_num);
 
     return -EBUSY;
@@ -1946,6 +1974,10 @@ static ssize_t sfp_bin_read(struct file *filp, struct kobject *kobj,
     return retval;
 
 exit_err:
+    if( (state == RTC0_STATUS_0_ERROR) &&
+        (get_filter_unpresent_case(attr)) ) { /*Filter xcvr unplug error case*/
+        return -ENXIO;
+    }
     pcie_err("%s ERROR(%d): Port%d pcie get done status failed!!", show_date_time(), state, pdata->port_num);
 
     return -EBUSY;
@@ -1992,6 +2024,10 @@ sfp_eeprom_write(struct bin_attribute *attr, char *buf, loff_t off, size_t count
     return count;
 
 exit_err:
+    if( (state == RTC0_STATUS_0_ERROR) &&
+        (get_filter_unpresent_case(attr)) ) { /*Filter xcvr unplug error case*/
+        return -ENXIO;
+    }
     pcie_err("%s ERROR(%d): Port%d pcie set failed!!", show_date_time(), state, pdata->port_num);
 
     return -EBUSY;