SBE FIFO: Change set #2

Ported the writeRequest functionality along with
waitUpFifoReady.

Change-Id: I4562df48d9e60b83d7f23964fb582f05f83a82c6
RTC:175100
Reviewed-on: http://ralgit01.raleigh.ibm.com/gerrit1/41933
Tested-by: FSP CI Jenkins <fsp-CI-jenkins+hostboot@us.ibm.com>
Reviewed-by: Prachi Gupta <pragupta@us.ibm.com>
Reviewed-by: Zane C. Shelley <zshelle@us.ibm.com>
Reviewed-by: Andres A. Lugo-Reyes <aalugore@us.ibm.com>
Reviewed-by: Martha Broyles <mbroyles@us.ibm.com>

2 files changed, 129 insertions, 0 deletions

diff --git a/src/occ_405/firdata/sbe_fifo.c b/src/occ_405/firdata/sbe_fifo.c
index 6f22a00..f3a68a9 100644
--- a/src/occ_405/firdata/sbe_fifo.c
+++ b/src/occ_405/firdata/sbe_fifo.c
@@ -24,6 +24,122 @@
 /* IBM_PROLOG_END_TAG                                                     */
 #include "sbe_fifo.h"
 #include <trac.h>
+#include <fsi.h>
+#include <native.h>
+
+/** @brief  Waits for FIFO to be ready to be written to
+ *  @param  i_target The SCOM target.
+ *  @return Non-SUCCESS if the SCOM fails. SUCCESS otherwise.
+ */
+uint32_t waitUpFifoReady(SCOM_Trgt_t* i_target)
+{
+    uint32_t l_rc = SUCCESS;
+
+    uint64_t l_elapsed_time_ns = 0;
+    uint32_t l_addr = SBE_FIFO_UPFIFO_STATUS;
+    uint32_t l_data = 0;
+
+    do
+    {
+        //Read upstream status to see if there is room for more data
+        l_rc = getfsi(*i_target, l_addr, &l_data);
+        if(l_rc != SUCCESS)
+        {
+            TRAC_ERR("waitUpFifoReady: failed to getfsi from addr 0x%08x",
+                     l_addr);
+            break;
+        }
+
+        if(!(l_data & UPFIFO_STATUS_FIFO_FULL))
+        {
+            break;
+        }
+
+        //Check for timeout
+        if(l_elapsed_time_ns >= MAX_UP_FIFO_TIMEOUT_NS)
+        {
+            l_rc = FAIL;
+            TRAC_ERR("waitUpFifoReady: timeout occurred while waiting for"
+                     " FIFO to clear");
+            break;
+        }
+
+        sleep(10000); //sleep for 10,000 ns
+        l_elapsed_time_ns += 10000;
+    }while(TRUE);
+
+    return l_rc;
+}
+
+/** @brief  Writes a request to FIFO
+ *  @param  i_target The SCOM target.
+ *  @param  i_fifoRequest the request to execute.
+ *  @return Non-SUCCESS if the SCOM fails. SUCCESS otherwise.
+ */
+uint32_t writeRequest(SCOM_Trgt_t* i_target, uint32_t* i_fifoRequest)
+{
+    uint32_t l_rc = SUCCESS;
+
+    TRAC_INFO("Enter writeRequest");
+
+    // Ensure Downstream Max Transfer Counter is 0 non-0 can cause
+    // protocol issues)
+    uint32_t l_addr = SBE_FIFO_DNFIFO_MAX_TSFR;
+    uint32_t l_data = 0;
+    l_rc = putfsi(*i_target, l_addr, l_data);
+    if(l_rc != SUCCESS)
+    {
+        TRAC_ERR("writeRequest: failed to putfsi to addr 0x%08x",
+                 l_addr);
+        return l_rc;
+    }
+
+    //The first uint32_t has the number of uint32_t words in the request
+    l_addr            = SBE_FIFO_UPFIFO_DATA_IN;
+    uint32_t* l_sent  = i_fifoRequest; //This pointer will advance as words are sent
+    uint32_t  l_count = *l_sent;
+    uint32_t  i;
+
+    for(i = 0; i < l_count; ++i)
+    {
+        //Wait for room to write into fifo
+        l_rc = waitUpFifoReady(i_target);
+        if(l_rc != SUCCESS)
+        {
+            return l_rc;
+        }
+
+        //Send data into fifo
+        l_rc = putfsi(*i_target, l_addr, *l_sent);
+        if(l_rc != SUCCESS)
+        {
+            TRAC_ERR("writeRequest: failed to putfsi to addr 0x%08x",
+                     l_addr);
+            return l_rc;
+        }
+
+        l_sent++;
+    }
+
+    //Notify SBE that last word has been sent
+    l_rc = waitUpFifoReady(i_target);
+    if(l_rc != SUCCESS)
+    {
+        return l_rc;
+    }
+
+    l_addr = SBE_FIFO_UPFIFO_SIG_EOT;
+    l_data = FSB_UPFIFO_SIG_EOT;
+    l_rc = putfsi(*i_target, l_addr, l_data);
+    if(l_rc != SUCCESS)
+    {
+        TRAC_ERR("writeRequest: failed to putfsi to addr 0x%08x", l_addr);
+    }
+
+    TRAC_INFO("Exit writeRequest");
+
+    return l_rc;
+}
 
 /** @brief  Performs a FIFO operation (read or write)
  *  @param  i_target The SCOM target.
@@ -41,6 +157,11 @@ uint32_t performFifoChipOp(SCOM_Trgt_t* i_target,
 
     TRAC_INFO("Enter performFifoChipOp");
 
+    l_rc = writeRequest(i_target, i_fifoRequest);
+    if(l_rc != SUCCESS)
+    {
+        return l_rc;
+    }
 
     TRAC_INFO("Exit performFifoChioOp");
 
diff --git a/src/occ_405/firdata/sbe_fifo.h b/src/occ_405/firdata/sbe_fifo.h
index 4905758..fdebbad 100644
--- a/src/occ_405/firdata/sbe_fifo.h
+++ b/src/occ_405/firdata/sbe_fifo.h
@@ -36,6 +36,14 @@
 #define SBE_FIFO_CMD_GET_SCOM 0x01
 #define SBE_FIFO_CMD_PUT_SCOM 0x02
 #define SBE_FIFO_CLASS_SCOM_ACCESS 0xA2
+#define SBE_FIFO_DNFIFO_MAX_TSFR 0x00002458
+#define SBE_FIFO_UPFIFO_DATA_IN 0x00002400
+#define SBE_FIFO_UPFIFO_SIG_EOT 0x00002408
+#define FSB_UPFIFO_SIG_EOT 0x80000000
+#define SBE_FIFO_UPFIFO_STATUS 0x00002404
+#define UPFIFO_STATUS_FIFO_FULL 0x00200000
+#define NS_PER_MSEC (1000000ull)
+#define MAX_UP_FIFO_TIMEOUT_NS 10*NS_PER_MSEC
 
 struct statusHeader
 {