Changeset 23 for trunk/kernel/drivers/soclib/soclib_bdv.c

Timestamp:

Jun 18, 2017, 10:06:41 PM (7 years ago)

Author:

alain

Message:

Introduce syscalls.

File:

• trunk/kernel/drivers/soclib/soclib_bdv.c (modified) (4 diffs)

trunk/kernel/drivers/soclib/soclib_bdv.c

@@ -53 +53 @@
 void __attribute__ ((noinline)) soclib_bdv_cmd( xptr_t th_xp )
 {
-    uint32_t   to_mem;       // command argument
+    uint32_t   cmd_type;     // IOC_READ / IOC_WRITE / IOC_SYNC_READ
     uint32_t   lba;          // command argument
     uint32_t   count;        // command argument
@@ -64 +64 @@
 
     // get command arguments and extended pointer on IOC device
-    to_mem =         hal_remote_lw ( XPTR( th_cxy , &th_ptr->command.ioc.to_mem ) );
-    lba    =         hal_remote_lw ( XPTR( th_cxy , &th_ptr->command.ioc.lba    ) );
-    count  =         hal_remote_lw ( XPTR( th_cxy , &th_ptr->command.ioc.count  ) );
-    buf_xp = (xptr_t)hal_remote_lwd( XPTR( th_cxy , &th_ptr->command.ioc.buf_xp ) );
-    dev_xp = (xptr_t)hal_remote_lwd( XPTR( th_cxy , &th_ptr->command.ioc.dev_xp ) );
+    cmd_type =         hal_remote_lw ( XPTR( th_cxy , &th_ptr->command.ioc.type   ) );
+    lba      =         hal_remote_lw ( XPTR( th_cxy , &th_ptr->command.ioc.lba    ) );
+    count    =         hal_remote_lw ( XPTR( th_cxy , &th_ptr->command.ioc.count  ) );
+    buf_xp   = (xptr_t)hal_remote_lwd( XPTR( th_cxy , &th_ptr->command.ioc.buf_xp ) );
+    dev_xp   = (xptr_t)hal_remote_lwd( XPTR( th_cxy , &th_ptr->command.ioc.dev_xp ) );
 
     // get IOC device cluster and local pointer
@@ -85 +85 @@
     uint32_t   buf_msb = (uint32_t)(buf_xp>>32);
 
-    // get access type
-    uint32_t   type =  to_mem ? BDV_OP_READ : BDV_OP_WRITE; 
+    // set operation
+    uint32_t   op;
+    if( cmd_type == IOC_WRITE ) op = BDV_OP_WRITE; 
+    else                        op = BDV_OP_READ;
 
     // set SOCLIB_BDV registers to start one I/O operation
@@ -94 +96 @@
     hal_remote_sw( XPTR( bdv_cxy , bdv_ptr + BDV_LBA_REG        ) , lba     );
     hal_remote_sw( XPTR( bdv_cxy , bdv_ptr + BDV_COUNT_REG      ) , count   );
-    hal_remote_sw( XPTR( bdv_cxy , bdv_ptr + BDV_OP_REG         ) , type    );
+    hal_remote_sw( XPTR( bdv_cxy , bdv_ptr + BDV_OP_REG         ) , op      );
 
-    // Block and deschedule server thread
-    thread_block( CURRENT_THREAD , THREAD_BLOCKED_DEV_ISR );
-    sched_yield();
+    // waiting policy  depends on the command type
+
+    if( cmd_type == IOC_SYNC_READ )                  // polling policy
+    {
+        uint32_t status;
+        while (1)
+        {
+            status = hal_remote_lw( XPTR( bdv_cxy , bdv_ptr + BDV_STATUS_REG ) );
+
+            if( status == BDV_READ_SUCCESS ) // successfully completed
+            {
+                hal_remote_sw( XPTR( th_cxy , &th_ptr->command.ioc.error ) , 0 );
+                break;
+            }
+            else if( status == BDV_BUSY )   // non completed
+            {
+                continue;
+            }
+            else                            // error reported
+            {
+                hal_remote_sw( XPTR( th_cxy , &th_ptr->command.ioc.error ) , 1 );
+                break;
+            }
+        }
+    }
+    else                                            // descheduling + IRQ policy
+    { 
+        thread_block( CURRENT_THREAD , THREAD_BLOCKED_DEV_ISR );
+        sched_yield();
+    }
     
 } // end soclib_bdv_cmd()