Usermode/Libraries/libc.so_src/fileIO.c

   1 /*\r
   2  * AcessOS Basic C Library\r
   3  * stdio.c\r
   4  */\r
   5 #include "config.h"\r
   6 #include <acess/sys.h>\r
   7 #include <stdlib.h>\r
   8 #include <stdio.h>\r
   9 #include <string.h>\r
  10 #include "lib.h"\r
  11 #include "stdio_int.h"\r
  12 \r
  13 #define DEBUG_BUILD     0\r
  14 \r
  15 // === CONSTANTS ===\r
  16 #define _stdin  0\r
  17 #define _stdout 1\r
  18 \r
  19 // === PROTOTYPES ===\r
  20 EXPORT void     itoa(char *buf, uint64_t num, uint base, int minLength, char pad, int bSigned);\r
  21 struct sFILE    *get_file_struct();\r
  22 \r
  23 // === GLOBALS ===\r
  24 struct sFILE    _iob[STDIO_MAX_STREAMS];        // IO Buffer\r
  25 struct sFILE    *stdin; // Standard Input\r
  26 struct sFILE    *stdout;        // Standard Output\r
  27 struct sFILE    *stderr;        // Standard Error\r
  28 ///\note Initialised in SoMain\r
  29 \r
  30 // === CODE ===\r
  31 /**\r
  32  * \fn FILE *freopen(char *file, char *mode, FILE *fp)\r
  33  */\r
  34 EXPORT FILE *freopen(const char *file, const char *mode, FILE *fp)\r
  35 {\r
  36          int    openFlags = 0;\r
  37          int    i;\r
  38         \r
  39         // Sanity Check Arguments\r
  40         if(!fp || !file || !mode)       return NULL;\r
  41         \r
  42         if(fp->Flags) {\r
  43                 fflush(fp);\r
  44         } else\r
  45                 fp->FD = -1;\r
  46         \r
  47         // Get main mode\r
  48         switch(mode[0])\r
  49         {\r
  50         case 'r':       fp->Flags = FILE_FLAG_MODE_READ;        break;\r
  51         case 'w':       fp->Flags = FILE_FLAG_MODE_WRITE;       break;\r
  52         case 'a':       fp->Flags = FILE_FLAG_MODE_APPEND;      break;\r
  53         case 'x':       fp->Flags = FILE_FLAG_MODE_EXEC;        break;\r
  54         default:\r
  55                 return NULL;\r
  56         }\r
  57         // Get Modifiers\r
  58         for(i=1;mode[i];i++)\r
  59         {\r
  60                 switch(mode[i])\r
  61                 {\r
  62                 case '+':       fp->Flags |= FILE_FLAG_M_EXT;\r
  63                 }\r
  64         }\r
  65         \r
  66         // Get Open Flags\r
  67         switch(mode[0])\r
  68         {\r
  69         // Read\r
  70         case 'r':       openFlags = OPENFLAG_READ;\r
  71                 if(fp->Flags & FILE_FLAG_M_EXT)\r
  72                         openFlags |= OPENFLAG_WRITE;\r
  73                 break;\r
  74         // Write\r
  75         case 'w':       openFlags = OPENFLAG_WRITE;\r
  76                 if(fp->Flags & FILE_FLAG_M_EXT)\r
  77                         openFlags |= OPENFLAG_READ;\r
  78                 break;\r
  79         // Execute\r
  80         case 'x':       openFlags = OPENFLAG_EXEC;\r
  81                 break;\r
  82         }\r
  83         \r
  84         //Open File\r
  85         if(fp->FD != -1)\r
  86                 fp->FD = reopen(fp->FD, file, openFlags);\r
  87         else\r
  88                 fp->FD = open(file, openFlags);\r
  89         if(fp->FD == -1) {\r
  90                 fp->Flags = 0;\r
  91                 return NULL;\r
  92         }\r
  93         \r
  94         if(mode[0] == 'a') {\r
  95                 seek(fp->FD, 0, SEEK_END);      //SEEK_END\r
  96         }\r
  97         \r
  98         return fp;\r
  99 }\r
 100 /**\r
 101  \fn FILE *fopen(const char *file, const char *mode)\r
 102  \brief Opens a file and returns the pointer\r
 103  \param file    String - Filename to open\r
 104  \param mode    Mode to open in\r
 105 */\r
 106 EXPORT FILE *fopen(const char *file, const char *mode)\r
 107 {\r
 108         FILE    *retFile;\r
 109         \r
 110         // Sanity Check Arguments\r
 111         if(!file || !mode)      return NULL;\r
 112         \r
 113         // Create Return Structure\r
 114         retFile = get_file_struct();\r
 115         \r
 116         return freopen(file, mode, retFile);\r
 117 }\r
 118 \r
 119 EXPORT void fclose(FILE *fp)\r
 120 {\r
 121         close(fp->FD);\r
 122         free(fp);\r
 123 }\r
 124 \r
 125 EXPORT void fflush(FILE *fp)\r
 126 {\r
 127         ///\todo Implement\r
 128 }\r
 129 \r
 130 EXPORT long int ftell(FILE *fp)\r
 131 {\r
 132         if(!fp || !fp->FD)      return -1;\r
 133         \r
 134         return tell(fp->FD);\r
 135 }\r
 136 \r
 137 EXPORT int fseek(FILE *fp, long int amt, int whence)\r
 138 {\r
 139         if(!fp || !fp->FD)      return -1;\r
 140         \r
 141         return seek(fp->FD, amt, whence);\r
 142 }\r
 143 \r
 144 \r
 145 /**\r
 146  * \fn EXPORT int vfprintf(FILE *fp, const char *format, va_list args)\r
 147  * \brief Print to a file from a variable argument list\r
 148  */\r
 149 EXPORT int vfprintf(FILE *fp, const char *format, va_list args)\r
 150 {\r
 151         va_list tmpList = args;\r
 152          int    size;\r
 153         char    sbuf[1024];\r
 154         char    *buf = sbuf;\r
 155          \r
 156         if(!fp || !format)      return -1;\r
 157         \r
 158         size = vsnprintf(sbuf, 1024, (char*)format, tmpList);\r
 159         \r
 160         if( size >= 1024 )\r
 161         {\r
 162                 buf = (char*)malloc(size+1);\r
 163                 if(!buf) {\r
 164                         write(_stdout, 31, "vfprintf ERROR: malloc() failed");\r
 165                         return 0;\r
 166                 }\r
 167                 buf[size] = '\0';\r
 168         \r
 169                 // Print\r
 170                 vsnprintf(buf, size+1, (char*)format, args);\r
 171         }\r
 172         \r
 173         // Write to stream\r
 174         write(fp->FD, size, buf);\r
 175         \r
 176         // Free buffer\r
 177         free(buf);\r
 178         \r
 179         // Return written byte count\r
 180         return size;\r
 181 }\r
 182 \r
 183 /**\r
 184  * \fn int fprintf(FILE *fp, const char *format, ...)\r
 185  * \brief Print a formatted string to a stream\r
 186  */\r
 187 EXPORT int fprintf(FILE *fp, const char *format, ...)\r
 188 {\r
 189         va_list args;\r
 190          int    ret;\r
 191         \r
 192         // Get Size\r
 193         va_start(args, format);\r
 194         ret = vfprintf(fp, (char*)format, args);\r
 195         va_end(args);\r
 196         \r
 197         return ret;\r
 198 }\r
 199 \r
 200 /**\r
 201  * \fn EXPORT size_t fwrite(void *ptr, size_t size, size_t num, FILE *fp)\r
 202  * \brief Write to a stream\r
 203  */\r
 204 EXPORT size_t fwrite(void *ptr, size_t size, size_t num, FILE *fp)\r
 205 {\r
 206          int    ret;\r
 207         if(!fp || !fp->FD)      return -1;\r
 208         \r
 209         ret = write(fp->FD, size*num, ptr);\r
 210         \r
 211         return ret;\r
 212 }\r
 213 \r
 214 /**\r
 215  * \fn EXPORT size_t fread(void *ptr, size_t size, size_t num, FILE *fp)\r
 216  * \brief Read from a stream\r
 217  */\r
 218 EXPORT size_t fread(void *ptr, size_t size, size_t num, FILE *fp)\r
 219 {\r
 220          int    ret;\r
 221         if(!fp || !fp->FD)      return -1;\r
 222         \r
 223         ret = read(fp->FD, size*num, ptr);\r
 224         \r
 225         return ret;\r
 226 }\r
 227 \r
 228 /**\r
 229  * \fn EXPORT int fputc(int c, FILE *fp)\r
 230  * \brief Write a single character to the stream\r
 231  */\r
 232 EXPORT int fputc(int c, FILE *fp)\r
 233 {\r
 234         if(!fp || !fp->FD)      return -1;\r
 235         return write(fp->FD, 1, &c);\r
 236 }\r
 237 \r
 238 /**\r
 239  * \fn EXPORT int fgetc(FILE *fp)\r
 240  * \brief Read a character from the stream\r
 241  */\r
 242 EXPORT int fgetc(FILE *fp)\r
 243 {\r
 244          int    ret = 0;\r
 245         if(!fp) return -1;\r
 246         if(read(fp->FD, 1, &ret) == -1) return -1;\r
 247         return ret;\r
 248 }\r
 249 \r
 250 // --- INTERNAL ---\r
 251 /**\r
 252  * \fn FILE *get_file_struct()\r
 253  * \brief Returns a file descriptor structure\r
 254  */\r
 255 FILE *get_file_struct()\r
 256 {\r
 257          int    i;\r
 258         for(i=0;i<STDIO_MAX_STREAMS;i++)\r
 259         {\r
 260                 if(_iob[i].Flags == 0)  return &_iob[i];\r
 261         }\r
 262         return NULL;\r
 263 }\r
 264 \r
 265 EXPORT int putchar(int ch)\r
 266 {\r
 267         return write(_stdout, 1, (char*)&ch);\r
 268 }\r
 269 \r
 270 EXPORT int      puts(const char *str)\r
 271 {\r
 272          int    len;\r
 273         \r
 274         if(!str)        return 0;\r
 275         len = strlen(str);\r
 276         \r
 277         len = write(_stdout, len, (char*)str);\r
 278         write(_stdout, 1, "\n");\r
 279         return len;\r
 280 }\r
 281 \r
 282 EXPORT int vsprintf(char * __s, const char *__format, va_list __args)\r
 283 {\r
 284         return vsnprintf(__s, 0x7FFFFFFF, __format, __args);\r
 285 }\r
 286 \r
 287 //sprintfv\r
 288 /**\r
 289  \fn EXPORT void vsnprintf(char *buf, const char *format, va_list args)\r
 290  \brief Prints a formatted string to a buffer\r
 291  \param buf     Pointer - Destination Buffer\r
 292  \param format  String - Format String\r
 293  \param args    VarArgs List - Arguments\r
 294 */\r
 295 EXPORT int vsnprintf(char *buf, size_t __maxlen, const char *format, va_list args)\r
 296 {\r
 297         char    tmp[65];\r
 298          int    c, minSize;\r
 299          int    pos = 0;\r
 300         char    *p;\r
 301         char    pad;\r
 302         uint64_t        arg;\r
 303          int    bLongLong;\r
 304 \r
 305         tmp[32] = '\0';\r
 306         \r
 307         while((c = *format++) != 0)\r
 308         {\r
 309                 // Non-control character\r
 310                 if (c != '%') {\r
 311                         if(buf && pos < __maxlen)       buf[pos] = c;\r
 312                         pos ++;\r
 313                         continue;\r
 314                 }\r
 315                 \r
 316                 // Control Character\r
 317                 c = *format++;\r
 318                 if(c == '%') {  // Literal %\r
 319                         if(buf && pos < __maxlen)       buf[pos] = '%';\r
 320                         pos ++;\r
 321                         continue;\r
 322                 }\r
 323                 \r
 324                 // Padding\r
 325                 if(c == '0') {\r
 326                         pad = '0';\r
 327                         c = *format++;\r
 328                 } else\r
 329                         pad = ' ';\r
 330                 minSize = 0;\r
 331                 if('1' <= c && c <= '9')\r
 332                 {\r
 333                         while('0' <= c && c <= '9')\r
 334                         {\r
 335                                 minSize *= 10;\r
 336                                 minSize += c - '0';\r
 337                                 c = *format++;\r
 338                         }\r
 339                 }\r
 340         \r
 341                 // Check for long long\r
 342                 bLongLong = 0;\r
 343                 if(c == 'l')\r
 344                 {\r
 345                         c = *format++;\r
 346                         if(c == 'l') {\r
 347                                 bLongLong = 1;\r
 348                         }\r
 349                 }\r
 350                         \r
 351                 p = tmp;\r
 352                 \r
 353                 // Get Type\r
 354                 switch( c )\r
 355                 {\r
 356                 // Signed Integer\r
 357                 case 'd':       case 'i':\r
 358                         // Get Argument\r
 359                         if(bLongLong)   arg = va_arg(args, int64_t);\r
 360                         else                    arg = va_arg(args, int32_t);\r
 361                         itoa(tmp, arg, 10, minSize, pad, 1);\r
 362                         goto sprintf_puts;\r
 363                 \r
 364                 // Unsigned Integer\r
 365                 case 'u':\r
 366                         // Get Argument\r
 367                         if(bLongLong)   arg = va_arg(args, uint64_t);\r
 368                         else                    arg = va_arg(args, uint32_t);\r
 369                         itoa(tmp, arg, 10, minSize, pad, 0);\r
 370                         goto sprintf_puts;\r
 371                 \r
 372                 // Pointer\r
 373                 case 'p':\r
 374                         if(buf && pos+2 < __maxlen) {\r
 375                                 buf[pos] = '*';\r
 376                                 buf[pos+1] = '0';\r
 377                                 buf[pos+2] = 'x';\r
 378                         }\r
 379                         pos += 3;\r
 380                         arg = va_arg(args, uint32_t);\r
 381                         itoa(tmp, arg, 16, minSize, pad, 0);\r
 382                         goto sprintf_puts;\r
 383                         // Fall through to hex\r
 384                 // Unsigned Hexadecimal\r
 385                 case 'x':\r
 386                         if(bLongLong)   arg = va_arg(args, uint64_t);\r
 387                         else                    arg = va_arg(args, uint32_t);\r
 388                         itoa(tmp, arg, 16, minSize, pad, 0);\r
 389                         goto sprintf_puts;\r
 390                 \r
 391                 // Unsigned Octal\r
 392                 case 'o':\r
 393                         if(bLongLong)   arg = va_arg(args, uint64_t);\r
 394                         else                    arg = va_arg(args, uint32_t);\r
 395                         itoa(tmp, arg, 8, minSize, pad, 0);\r
 396                         goto sprintf_puts;\r
 397                 \r
 398                 // Unsigned binary\r
 399                 case 'b':\r
 400                         if(bLongLong)   arg = va_arg(args, uint64_t);\r
 401                         else                    arg = va_arg(args, uint32_t);\r
 402                         itoa(tmp, arg, 2, minSize, pad, 0);\r
 403                         goto sprintf_puts;\r
 404 \r
 405                 // String\r
 406                 case 's':\r
 407                         arg = va_arg(args, uint32_t);\r
 408                         p = (void*)(intptr_t)arg;\r
 409                 sprintf_puts:\r
 410                         if(!p)  p = "(null)";\r
 411                         //_SysDebug("vsnprintf: p = '%s'", p);\r
 412                         if(buf) {\r
 413                                 while(*p) {\r
 414                                         if(pos < __maxlen)      buf[pos] = *p;\r
 415                                         pos ++; p ++;\r
 416                                 }\r
 417                         }\r
 418                         else {\r
 419                                 while(*p) {\r
 420                                         pos++; p++;\r
 421                                 }\r
 422                         }\r
 423                         break;\r
 424 \r
 425                 // Unknown, just treat it as a character\r
 426                 default:\r
 427                         arg = va_arg(args, uint32_t);\r
 428                         if(buf && pos < __maxlen)       buf[pos] = arg;\r
 429                         pos ++;\r
 430                         break;\r
 431                 }\r
 432     }\r
 433         if(buf && pos < __maxlen)       buf[pos] = '\0';\r
 434         \r
 435         //_SysDebug("vsnprintf: buf = '%s'", buf);\r
 436         \r
 437         return pos;\r
 438 }\r
 439 \r
 440 const char cUCDIGITS[] = "0123456789ABCDEF";\r
 441 /**\r
 442  * \fn static void itoa(char *buf, uint64_t num, int base, int minLength, char pad, int bSigned)\r
 443  * \brief Convert an integer into a character string\r
 444  */\r
 445 EXPORT void itoa(char *buf, uint64_t num, size_t base, int minLength, char pad, int bSigned)\r
 446 {\r
 447         char    tmpBuf[64];\r
 448          int    pos=0, i;\r
 449 \r
 450         if(!buf)        return;\r
 451         if(base > 16 || base < 2) {\r
 452                 buf[0] = 0;\r
 453                 return;\r
 454         }\r
 455         \r
 456         if(bSigned && (int64_t)num < 0)\r
 457         {\r
 458                 num = -num;\r
 459                 bSigned = 1;\r
 460         } else\r
 461                 bSigned = 0;\r
 462         \r
 463         while(num > base-1) {\r
 464                 tmpBuf[pos++] = cUCDIGITS[ num % base ];\r
 465                 num = (uint64_t) num / (uint64_t)base;          // Shift {number} right 1 digit\r
 466         }\r
 467 \r
 468         tmpBuf[pos++] = cUCDIGITS[ num % base ];                // Last digit of {number}\r
 469         if(bSigned)     tmpBuf[pos++] = '-';    // Append sign symbol if needed\r
 470         \r
 471         i = 0;\r
 472         minLength -= pos;\r
 473         while(minLength-- > 0)  buf[i++] = pad;\r
 474         while(pos-- > 0)                buf[i++] = tmpBuf[pos]; // Reverse the order of characters\r
 475         buf[i] = 0;\r
 476 }\r
 477 \r
 478 /**\r
 479  * \fn EXPORT int printf(const char *format, ...)\r
 480  * \brief Print a string to stdout\r
 481  */\r
 482 EXPORT int printf(const char *format, ...)\r
 483 {\r
 484         #if 1\r
 485          int    size;\r
 486         char    sbuf[1024];\r
 487         char    *buf = sbuf;\r
 488         va_list args;\r
 489         \r
 490         // Get final size\r
 491         va_start(args, format);\r
 492         size = vsnprintf(sbuf, 1024, (char*)format, args);\r
 493         va_end(args);\r
 494         \r
 495         if( size >= 1024 ) {\r
 496                 // Allocate buffer\r
 497                 buf = (char*)malloc(size+1);\r
 498                 if(buf) {\r
 499                         write(_stdout, 29, "PRINTF ERROR: malloc() failed");\r
 500                         return 0;\r
 501                 }\r
 502                 buf[size] = '\0';\r
 503         \r
 504                 // Fill Buffer\r
 505                 va_start(args, format);\r
 506                 vsnprintf(buf, size+1, (char*)format, args);\r
 507                 va_end(args);\r
 508         }\r
 509         \r
 510         // Send to stdout\r
 511         write(_stdout, size+1, buf);\r
 512         \r
 513         // Free buffer\r
 514         free(buf);\r
 515         // Return\r
 516         return size;\r
 517         \r
 518         #else\r
 519         \r
 520          int    ret;\r
 521         va_list args;\r
 522         va_start(args, format);\r
 523         ret = fprintfv(stdout, (char*)format, args);\r
 524         va_end(args);\r
 525         return ret;\r
 526         #endif\r
 527 }\r
 528 \r
 529 /**\r
 530  * \fn EXPORT int sprintf(const char *buf, char *format, ...)\r
 531  * \brief Print a formatted string to a buffer\r
 532  */\r
 533 EXPORT int sprintf(char *buf, const char *format, ...)\r
 534 {\r
 535          int    ret;\r
 536         va_list args;\r
 537         va_start(args, format);\r
 538         ret = vsprintf((char*)buf, (char*)format, args);\r
 539         va_end(args);\r
 540         return ret;\r
 541 }\r