* AcessOS Basic C Library\r
*/\r
#include "stdio_int.h"\r
+#include "lib.h"\r
+#include <stdio.h>\r
+#include <sys/sys.h>\r
\r
+#define USE_CPUID 0\r
+\r
+// === TYPES ===\r
+typedef struct {\r
+ intptr_t Base;\r
+ char *Name;\r
+} tLoadedLib;\r
+\r
+// === PROTOTYPES ===\r
+#if USE_CPUID\r
+static void cpuid(uint32_t Num, uint32_t *EAX, uint32_t *EBX, uint32_t *EDX, uint32_t *ECX);\r
+#endif\r
+ int ErrorHandler(int Fault);\r
+\r
+// === IMPORTS ===\r
+extern tLoadedLib gLoadedLibraries[64];\r
+extern int _SysSetFaultHandler(int (*Handler)(int));\r
+\r
+// === GLOBALS ===\r
extern char **_envp;\r
extern struct sFILE _iob[];\r
extern struct sFILE *stdin;\r
extern struct sFILE *stdout;\r
extern struct sFILE *stderr;\r
+// --- CPU Features ---\r
+#if USE_CPUID\r
+tCPUID gCPU_Features;\r
+#endif\r
\r
+// === CODE ===\r
/**\r
* \fn int SoMain()\r
* \brief Stub Entrypoint\r
{\r
// Init for env.c\r
_envp = envp;\r
+\r
+ #if 0 \r
+ {\r
+ int i = 0;\r
+ char **tmp;\r
+ _SysDebug("envp = %p", envp);\r
+ for(tmp = envp; *tmp; tmp++,i++)\r
+ {\r
+ _SysDebug("envp[%i] = '%s'", i, *tmp);\r
+ }\r
+ }\r
+ #endif\r
\r
// Init FileIO Pointers\r
stdin = &_iob[0];\r
stderr = &_iob[2];\r
stderr->FD = 2; stderr->Flags = FILE_FLAG_MODE_WRITE;\r
\r
+ #if USE_CPUID\r
+ {\r
+ uint32_t ecx, edx;\r
+ cpuid(1, NULL, NULL, &edx, &ecx);\r
+ gCPU_Features.SSE = edx & (1 << 25); // SSE\r
+ gCPU_Features.SSE2 = edx & (1 << 26); // SSE2\r
+ }\r
+ #endif\r
+ \r
+ // Set Error handler\r
+ _SysSetFaultHandler(ErrorHandler);\r
+ \r
return 1;\r
}\r
+\r
+int ErrorHandler(int Fault)\r
+{\r
+ int i;\r
+ fprintf(stderr, "ErrorHandler: (Fault = %i)\n", Fault);\r
+ fprintf(stderr, "Loaded Libraries:\n");\r
+ for( i = 0; i < 64; i ++ )\r
+ {\r
+ //if(gLoadedLibraries[i].Base == 0) continue;\r
+ // fprintf(stderr, "%02i: %p %s\n", i, gLoadedLibraries[i].Base, gLoadedLibraries[i].Name);\r
+ }\r
+ fprintf(stderr, "\n");\r
+ exit(-1);\r
+ return -1;\r
+}\r
+\r
+#if USE_CPUID\r
+/**\r
+ * \brief Call the CPUID opcode\r
+ */\r
+static void cpuid(uint32_t Num, uint32_t *EAX, uint32_t *EBX, uint32_t *EDX, uint32_t *ECX)\r
+{\r
+ uint32_t eax, ebx, edx, ecx;\r
+ \r
+ __asm__ __volatile__ (\r
+ "cpuid"\r
+ : "=a"(eax), "=c"(ecx), "=d"(edx)\r
+ : "a"(Num)\r
+ );\r
+ \r
+ if(EAX) *EAX = eax;\r
+ if(EBX) *EBX = ebx;\r
+ if(EDX) *EDX = edx;\r
+ if(ECX) *ECX = ecx;\r
+}\r
+#endif\r