KernelLand/Modules/Interfaces/UDI/main.c

   1 /*
   2  * Acess2 UDI Layer
   3  */
   4 #define DEBUG   0
   5 #define VERSION ((0<<8)|1)
   6 #include <acess.h>
   7 #include <modules.h>
   8 #include <udi.h>
   9
  10 // === PROTOTYPES ===
  11  int    UDI_Install(char **Arguments);
  12  int    UDI_DetectDriver(void *Base);
  13  int    UDI_LoadDriver(void *Base);
  14
  15 // === GLOBALS ===
  16 MODULE_DEFINE(0, VERSION, UDI, UDI_Install, NULL, NULL);
  17 tModuleLoader   gUDI_Loader = {
  18         NULL, "UDI", UDI_DetectDriver, UDI_LoadDriver, NULL
  19 };
  20
  21 // === CODE ===
  22 /**
  23  * \fn int UDI_Install(char **Arguments)
  24  * \brief Stub intialisation routine
  25  */
  26 int UDI_Install(char **Arguments)
  27 {
  28         Module_RegisterLoader( &gUDI_Loader );
  29         return MODULE_ERR_OK;
  30 }
  31
  32 /**
  33  * \brief Detects if a driver should be loaded by the UDI subsystem
  34  */
  35 int UDI_DetectDriver(void *Base)
  36 {
  37         if( Binary_FindSymbol(Base, "udi_init_info", NULL) == 0) {
  38                 return 0;
  39         }
  40
  41         return 1;
  42 }
  43
  44 /**
  45  * \fn int UDI_LoadDriver(void *Base)
  46  */
  47 int UDI_LoadDriver(void *Base)
  48 {
  49         udi_init_t      *info;
  50         char    *udiprops = NULL;
  51         Uint    udiprops_size = 0;
  52          int    i;
  53         // int  j;
  54
  55         ENTER("pBase", Base);
  56
  57         if( Binary_FindSymbol(Base, "udi_init_info", (Uint*)&info) == 0) {
  58                 Binary_Unload(Base);
  59                 LEAVE('i', 0);
  60                 return 0;
  61         }
  62
  63         if( Binary_FindSymbol(Base, "_udiprops", (Uint*)&udiprops) == 0 ) {
  64                 Log_Warning("UDI", "_udiprops is not defined, this is usually bad");
  65         }
  66         else if( Binary_FindSymbol(Base, "_udiprops_size", &udiprops_size) == 0) {
  67                 Log_Warning("UDI", "_udiprops_size is not defined");
  68         }
  69         else {
  70                  int    i, j, nLines;
  71                 char    **udipropsptrs;
  72
  73                 Log_Debug("UDI", "udiprops = %p, udiprops_size = 0x%x", udiprops, udiprops_size);
  74
  75                 Debug_HexDump("UDI_LoadDriver", udiprops, udiprops_size);
  76
  77                 nLines = 1;
  78                 for( i = 0; i < udiprops_size; i++ )
  79                 {
  80                         if( udiprops[i] == '\0' )
  81                                 nLines ++;
  82                 }
  83
  84                 Log_Debug("UDI", "nLines = %i", nLines);
  85
  86                 udipropsptrs = malloc( sizeof(char*)*nLines );
  87                 udipropsptrs[0] = udiprops;
  88                 j = 0;
  89                 for( i = 0; i < udiprops_size; i++ )
  90                 {
  91                         if( udiprops[i] == '\0' ) {
  92                                 //Log_Debug("UDI", "udipropsptrs[%i] = '%s'", j, udipropsptrs[j]);
  93                                 udipropsptrs[j++] = &udiprops[i+1];
  94                         }
  95                 }
  96                 Log_Debug("UDI", "udipropsptrs[%i] = '%s'", j, udipropsptrs[j]);
  97                 Log_Debug("UDI", "udiprops = \"%s\"", udiprops);
  98         }
  99
 100
 101         Log("primary_init_info = %p = {", info->primary_init_info);
 102         {
 103                 Log(" .mgmt_ops = %p = {", info->primary_init_info->mgmt_ops);
 104                 Log("  .usage_ind_op: %p() - 0x%02x",
 105                         info->primary_init_info->mgmt_ops->usage_ind_op,
 106                         info->primary_init_info->mgmt_op_flags[0]
 107                         );
 108                 Log("  .enumerate_req_op: %p() - 0x%02x",
 109                         info->primary_init_info->mgmt_ops->enumerate_req_op,
 110                         info->primary_init_info->mgmt_op_flags[1]
 111                         );
 112                 Log("  .devmgmt_req_op: %p() - 0x%02x",
 113                         info->primary_init_info->mgmt_ops->devmgmt_req_op,
 114                         info->primary_init_info->mgmt_op_flags[2]
 115                         );
 116                 Log("  .final_cleanup_req_op: %p() - 0x%02x",
 117                         info->primary_init_info->mgmt_ops->final_cleanup_req_op,
 118                         info->primary_init_info->mgmt_op_flags[3]
 119                         );
 120                 Log(" }");
 121                 Log(" .mgmt_scratch_requirement = 0x%x", info->primary_init_info->mgmt_scratch_requirement);
 122                 Log(" .enumeration_attr_list_length = 0x%x", info->primary_init_info->enumeration_attr_list_length);
 123                 Log(" .rdata_size = 0x%x", info->primary_init_info->rdata_size);
 124                 Log(" .child_data_size = 0x%x", info->primary_init_info->child_data_size);
 125                 Log(" .per_parent_paths = 0x%x", info->primary_init_info->per_parent_paths);
 126         }
 127         Log("}");
 128         Log("secondary_init_list = %p", info->secondary_init_list);
 129         Log("ops_init_list = %p", info->ops_init_list);
 130
 131         for( i = 0; info->ops_init_list[i].ops_idx; i++ )
 132         {
 133                 Log("info->ops_init_list[%i] = {", i);
 134                 Log(" .ops_idx = 0x%x", info->ops_init_list[i].ops_idx);
 135                 Log(" .meta_idx = 0x%x", info->ops_init_list[i].meta_idx);
 136                 Log(" .meta_ops_num = 0x%x", info->ops_init_list[i].meta_ops_num);
 137                 Log(" .chan_context_size = 0x%x", info->ops_init_list[i].chan_context_size);
 138                 Log(" .ops_vector = %p", info->ops_init_list[i].ops_vector);
 139 //              Log(" .op_flags = %p", info->ops_init_list[i].op_flags);
 140                 Log("}");
 141         }
 142
 143         return 0;
 144 }