Subversion Repositories SvarDOS

/*
 * replacement for a couple of libc functions
 */

#include <i86.h>
#include <stddef.h>

#include "libc.h"


size_t strlen(const char *s) {
  const char *ptr = s;
  while (*ptr != 0) ptr++;
  return(ptr - s);
}

void bzero(void *ptr, size_t len) {
  char *p = ptr;
  while (len > 0) {
    *p = 0;
    p++;
    len--;
  }
}

/* TODO this function does not handle overlapping strings well! */
void fmemmove(void far *dst, const void far *src, size_t len) {
  while (len-- > 0) {
    *(char far *)dst = *(char far *)src;
    dst = (char far *)dst + 1;
    src = (char far *)src + 1;
  }
}


unsigned short mdr_dos_resizeblock(unsigned short siz, unsigned short segn) {
  unsigned short res = 0;

  _asm {
    push bx
    push es

    mov ah, 0x4a
    mov bx, siz
    mov es, segn
    int 0x21
    jnc done
    mov res, ax

    done:

    pop es
    pop bx
  }

  return(res);
}


unsigned short mdr_dos_read(unsigned short handle, void far *buf, unsigned short count, unsigned short *bytes) {
  unsigned short res = 0;
  unsigned short resax = 0;
  unsigned short buf_off = FP_OFF(buf);
  unsigned short buf_seg = FP_SEG(buf);

  _asm {
    push bx,
    push cx
    push dx

    mov ah, 0x3f
    mov bx, handle
    mov cx, count
    mov dx, buf_off
    push ds
    mov ds, buf_seg
    int 0x21
    pop ds

    jnc done
    mov res, ax

    done:
    mov resax, ax

    pop dx
    pop cx
    pop bx
  }

  *bytes = resax;
  return(res);
}


unsigned short mdr_dos_write(unsigned short handle, const void far *buf, unsigned short count, unsigned short *bytes) {
  unsigned short res = 0;
  unsigned short resax = 0;
  unsigned short buf_seg = FP_SEG(buf);
  unsigned short buf_off = FP_OFF(buf);

  _asm {
    push bx
    push cx
    push dx

    mov ah, 0x40
    mov bx, handle
    mov cx, count
    mov dx, buf_off
    push ds
    mov ds, buf_seg

    int 0x21
    pop ds
    jnc done
    mov res, ax

    done:
    mov resax, ax

    pop dx
    pop cx
    pop bx
  }

  *bytes = resax;
  return(res);
}