Changeset 550 for trunk/kernel/kern

Timestamp:

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

Author:

nicolas.van.phan@…

Message:

Add SD card driver in kernel

File:

• trunk/kernel/kern/kernel_init.c (modified) (4 diffs)

trunk/kernel/kern/kernel_init.c

@@ -423 +423 @@
         }
 
+        ///////////////////////////////
         else if ( func == DEV_FUNC_TXT && info->use_mty0 == 1 )
         {
@@ -465 +466 @@
                         }
                     }
+#if( DEBUG_KERNEL_INIT & 0x1 )
+if( hal_time_stamp() > DEBUG_KERNEL_INIT )
+printk("\n[DBG] %s : created MTY[%d] in cluster %x / chdev = %x\n",
+__FUNCTION__ , channel , local_cxy , chdev_ptr );
+#endif
                 }
             }
         }
+
+        ///////////////////////////////
+        else if ( func == DEV_FUNC_IOC )
+        {
+            assert(impl == IMPL_IOC_SPI, __FUNCTION__,
+                "Internal IOC should have SPI implementation\n");
+
+            for ( channel = 0; channel < channels; channel++ )
+            {
+                // create chdev in local cluster
+                chdev_ptr = chdev_create( func,
+                                          impl,
+                                          channel,
+                                          0,
+                                          base );
+
+                assert( (chdev_ptr != NULL) , __FUNCTION__ , 
+                    "cannot allocate memory for IOC chdev" );
+                
+                // make IOC specific initialization
+                dev_ioc_init( chdev_ptr );
+
+                // set the IOC fields in all clusters
+                xptr_t *chdev_entry = &chdev_dir.ioc[channel];
+                for ( x = 0; x < info->x_max; x++ )
+                {
+                    for ( y = 0; y < info->y_max; y++ )
+                    {
+                        cxy_t cxy = (x<<info->y_width) + y;
+                        hal_remote_swd( XPTR( cxy, chdev_entry ),
+                                        XPTR( local_cxy, chdev_ptr ) );
+                    }
+    }
+#if( DEBUG_KERNEL_INIT & 0x1 )
+if( hal_time_stamp() > DEBUG_KERNEL_INIT )
+printk("\n[DBG] %s : created IOC[%d] in cluster %x / chdev = %x\n",
+__FUNCTION__ , channel , local_cxy , chdev_ptr );
+#endif
+            }
+        }
+
     }
 }  // end internal_devices_init()
@@ -556 +603 @@
                 }
 
+                if ( func == DEV_FUNC_IOC && impl == IMPL_IOC_SPI )
+                {
+                    continue;
+                }
+
                 // compute target cluster for chdev[func,channel,direction]
                 uint32_t offset     = ext_chdev_gid % ( info->x_size * (info->y_max) ); // [FIXME]
@@ -814 +866 @@
                 else if( func == DEV_FUNC_DMA ) lapic_input.dma[channel] = id;
                 else if( func == DEV_FUNC_TXT ) lapic_input.mtty = id;
+                else if( func == DEV_FUNC_IOC ) lapic_input.sdcard = id;
                 else assert( false , "illegal source device for LAPIC input" );
             }