Changeset 550 for trunk/hal/tsar_mips32/drivers/soclib_sdc.c

Timestamp:

Sep 21, 2018, 10:24:15 PM (6 years ago)

Author:

nicolas.van.phan@…

Message:

Add SD card driver in kernel

File:

• trunk/hal/tsar_mips32/drivers/soclib_sdc.c (modified) (8 diffs)

trunk/hal/tsar_mips32/drivers/soclib_sdc.c

@@ -6 +6 @@
 ///////////////////////////////////////////////////////////////////////////////////
 
-//#include <hard_config.h>
+// #include <hard_config.h>
 #include <soclib_sdc.h>
 //#include <tty0.h>
 //#include <utils.h>
+#include <hal_kernel_types.h>
+#include <chdev.h>
+#include <dev_ioc.h>
+#include <thread.h>
 #include <printk.h>
 
@@ -334 +338 @@
 
 ////////////////////////
-unsigned int _sdc_init()
+void soclib_sdc_init( chdev_t* chdev )
 {
     spi = (struct spi_dev*)SEG_IOC_BASE;
@@ -393 +397 @@
     printk("[SDC WARNING] Finish SD card initialization\n\r");
 
-    return 0;
-} // end _sdc_init()
-
+    /* Initialize the chdev */
+    // get extended pointer on SOCLIB_BDV peripheral base address
+        xptr_t  sdc_xp = chdev->base;
+
+    // set driver specific fields
+    chdev->cmd = &soclib_sdc_cmd;
+    chdev->isr = &soclib_sdc_isr;
+
+} // end soclib_sdc_init()
 
 /////////////////////////////////////////////////////
-unsigned int _sdc_access( unsigned int       use_irq,  // unused
-                          unsigned int       to_mem,
-                          unsigned int       lba,
-                          unsigned long long buf_paddr,
-                          unsigned int       count )
-{
+void __attribute__ ((noinline)) soclib_sdc_cmd( xptr_t th_xp )
+{
+    cxy_t      th_cxy = GET_CXY( th_xp );
+    thread_t * th_ptr = GET_PTR( th_xp );
+
+    // get command arguments and extended pointer on IOC device
+    uint32_t        cmd_type =         hal_remote_lw ( XPTR( th_cxy , &th_ptr->ioc_cmd.type   ) );
+    unsigned int    lba      =         hal_remote_lw ( XPTR( th_cxy , &th_ptr->ioc_cmd.lba ) );
+    xptr_t          buf_xp   = (xptr_t)hal_remote_lwd( XPTR( th_cxy , &th_ptr->ioc_cmd.buf_xp ) );
+    unsigned int    count    =         hal_remote_lw ( XPTR( th_cxy , &th_ptr->ioc_cmd.count  ) );
+
     unsigned char args[4];
     unsigned char sdcard_rsp;
@@ -410 +425 @@
     unsigned int last = lba + count;
 
-    if ( to_mem )  // read access
+    if ( cmd_type == IOC_SYNC_READ )  // read access
     {
         for ( ; curr < last ; curr++ )
@@ -432 +447 @@
             _sdc_wait_data_block();
 
-            if (spi_get_data(sdcard.spi, buf_paddr, 512 ))
+            if (spi_get_data(sdcard.spi, buf_xp, 512 ))
             {
                 _sdc_disable();
@@ -444 +459 @@
             _sdc_disable();
 
-            buf_paddr += 512;
+            buf_xp += 512;
         }
     }
@@ -451 +466 @@
         assert( false, __FUNCTION__, "[SDC ERROR] function _sdc_write() not iplemented yet\n");
     }
-
-    return 0;
 }  // _end sdc_access()
 
@@ -458 +471 @@
 // This ISR handles the IRQ generated by a SDC controler
 ///////////////////////////////////////////////////////////////////////////////
-void _sdc_isr( unsigned int irq_type,
-               unsigned int irq_id,
-               unsigned int channel )
+void __attribute__ ((noinline)) soclib_sdc_isr( chdev_t * chdev )
 {
     assert( false, __FUNCTION__, "\n[GIET ERROR] _sdc_isr() not implemented\n");