/* The system call implemented in this file:
 *   m_type:	SYS_DEVIO
 *
 * The parameters for this system call are:
 *    m2_i3:	DIO_REQUEST	(request input or output)	
 *    m2_i1:	DIO_TYPE	(flag indicating byte, word, or long)
 *    m2_l1:	DIO_PORT	(port to read/ write)	
 *    m2_l2:	DIO_VALUE	(value to write/ return value read)	
 *
 * Author:
 *    Jorrit N. Herder <jnherder@cs.vu.nl>
 */

#include "../kernel.h"
#include "../system.h"
#include <minix/devio.h>

/*===========================================================================*
 *			        do_devio                                     *
 *===========================================================================*/
PUBLIC int do_devio(m_ptr)
register message *m_ptr;	/* pointer to request message */
{
    /* perform actual device I/O for byte, word, and long values */
    if (m_ptr->DIO_REQUEST == DIO_INPUT) { 
      switch (m_ptr->DIO_TYPE) {
        case DIO_BYTE: m_ptr->DIO_VALUE = inb(m_ptr->DIO_PORT); break; 
        case DIO_WORD: m_ptr->DIO_VALUE = inw(m_ptr->DIO_PORT); break; 
        case DIO_LONG: m_ptr->DIO_VALUE = inl(m_ptr->DIO_PORT); break; 
    	default: return(EINVAL);
      } 
    } else { 
      switch (m_ptr->DIO_TYPE) {
        case DIO_BYTE: outb(m_ptr->DIO_PORT, m_ptr->DIO_VALUE); break;  
        case DIO_WORD: outw(m_ptr->DIO_PORT, m_ptr->DIO_VALUE); break;  
        case DIO_LONG: outl(m_ptr->DIO_PORT, m_ptr->DIO_VALUE); break;  
    	default: return(EINVAL);
      } 
    }
    return(OK);
}


/* The system call implemented in this file:
 *   m_type:	SYS_SDEVIO
 *
 * The parameters for this system call are:
 *    m2_i3:	DIO_REQUEST	(request input or output)	
 *    m2_i1:	DIO_TYPE	(flag indicating byte, word, or long)
 *    m2_l1:	DIO_PORT	(port to read/ write)	
 *    m2_p1:	DIO_VEC_ADDR	(virtual address of buffer)	
 *    m2_l2:	DIO_VEC_SIZE	(number of elements)	
 *    m2_i2:	DIO_VEC_PROC	(process where buffer is)	
 */

/*===========================================================================*
 *			        do_sdevio                                    *
 *===========================================================================*/
PUBLIC int do_sdevio(m_ptr)
register message *m_ptr;	/* pointer to request message */
{
  int proc_nr = m_ptr->DIO_VEC_PROC;
  int count = m_ptr->DIO_VEC_SIZE;
  long port = m_ptr->DIO_PORT;
  phys_bytes phys_buf;

  /* Check if process number is OK. */
  if (proc_nr == SELF) proc_nr = m_ptr->m_source;
  if (! isokprocn(proc_nr))
      return(EINVAL);

  /* Get and check physical address. */
  if ((phys_buf = numap_local(proc_nr, (vir_bytes) m_ptr->DIO_VEC_ADDR, count)) == 0)
      return(EFAULT);

  /* Perform device I/O for bytes and words. Longs are not supported. */
  if (m_ptr->DIO_REQUEST == DIO_INPUT) { 
      switch (m_ptr->DIO_TYPE) {
      case DIO_BYTE: phys_insb(port, phys_buf, count); break; 
      case DIO_WORD: phys_insw(port, phys_buf, count); break; 
      default: return(EINVAL);
      } 
  } else if (m_ptr->DIO_REQUEST == DIO_OUTPUT) { 
      switch (m_ptr->DIO_TYPE) {
      case DIO_BYTE: phys_outsb(port, phys_buf, count); break;  
      case DIO_WORD: phys_outsw(port, phys_buf, count); break;  
      default: return(EINVAL);
      } 
  }
  else {
      return(EINVAL);
  }
  return(OK);
}


/* The system call implemented in this file:
 *   m_type:	SYS_VDEVIO
 *
 * The parameters for this system call are:
 *    m2_i3:	DIO_REQUEST	(request input or output)	
 *    m2_i1:	DIO_TYPE	(flag indicating byte, word, or long)
 *    m2_p1:	DIO_VEC_ADDR	(pointer to port/ value pairs)	
 *    m2_i2:	DIO_VEC_SIZE	(number of ports to read or write) 
 */

/* Buffer for SYS_VDEVIO to copy (port,value)-pairs from/ to user. */
PRIVATE char vdevio_pv_buf[VDEVIO_BUF_SIZE];      

/* SYS_VDEVIO sends a pointer to a (port,value)-pairs vector at the caller. 
 * Define the maximum number of (port,value)-pairs that can be handled in a 
 * in a single SYS_VDEVIO system call based on the struct definitions. 
 */
#define MAX_PVB_PAIRS ((VDEVIO_BUF_SIZE * sizeof(char)) / sizeof(pvb_pair_t))
#define MAX_PVW_PAIRS ((VDEVIO_BUF_SIZE * sizeof(char)) / sizeof(pvw_pair_t))
#define MAX_PVL_PAIRS ((VDEVIO_BUF_SIZE * sizeof(char)) / sizeof(pvl_pair_t))
	

/*===========================================================================*
 *			        do_vdevio                                    *
 *===========================================================================*/
PUBLIC int do_vdevio(m_ptr)
register message *m_ptr;	/* pointer to request message */
{
/* Perform a series of device I/O on behalf of a non-kernel process. The 
 * I/O addresses and I/O values are fetched from and returned to some buffer
 * in user space. The actual I/O is wrapped by lock() and unlock() to prevent
 * that I/O batch from being interrrupted.
 * This is the counterpart of do_devio, which performs a single device I/O. 
 */ 
    pvb_pair_t *pvb_pairs;      /* needed for byte values */
    pvw_pair_t *pvw_pairs;      /* needed for word values */
    pvl_pair_t *pvl_pairs;      /* needed for long values */
    int i;
    pid_t caller_pid;           /* process id of caller */
    size_t bytes;               /* # bytes to be copied */
    vir_bytes caller_vir;       /* virtual address at caller */
    phys_bytes caller_phys;     /* physical address at caller */
    phys_bytes kernel_phys;     /* physical address in kernel */

    
    /* Check if nr of ports is ok and get size of (port,value) data. */
    if (m_ptr->DIO_VEC_SIZE <= 0) return(EINVAL);
    switch(m_ptr->DIO_TYPE) {
    	case DIO_BYTE:
    	    if (m_ptr->DIO_VEC_SIZE > MAX_PVB_PAIRS)  return(EINVAL);
    	    bytes = (size_t) (m_ptr->DIO_VEC_SIZE * sizeof(pvb_pair_t));
    	    break;
    	case DIO_WORD:
    	    if (m_ptr->DIO_VEC_SIZE > MAX_PVW_PAIRS)  return(EINVAL);
    	    bytes = (size_t) (m_ptr->DIO_VEC_SIZE * sizeof(pvw_pair_t));
    	    break;
    	case DIO_LONG:
    	    if (m_ptr->DIO_VEC_SIZE > MAX_PVL_PAIRS)  return(EINVAL);
    	    bytes = (size_t) (m_ptr->DIO_VEC_SIZE * sizeof(pvl_pair_t));
    	    break;
    	default:	/* this once and for all checks for a correct type */
    	    return(EINVAL);
    }

    /* Calculate physical addresses and copy (port,value)-pairs from user. */
    caller_pid = (pid_t) m_ptr->m_source; 
    caller_vir = (vir_bytes) m_ptr->DIO_VEC_ADDR;
    caller_phys = umap_local(proc_addr(caller_pid), D, caller_vir, bytes);
    if (0 == caller_phys) return EFAULT;
    kernel_phys = vir2phys(vdevio_pv_buf);
    phys_copy(caller_phys, kernel_phys, (phys_bytes) bytes);

    /* Perform actual device I/O for byte, word, and long values. Note that 
    * the entire switch is wrapped in lock() and unlock() to prevent the I/O
    * batch from being interrupted. It may be cleaner to do this just around 
    * the for loops, but this results in rather lenghty code.
    */
    lock();
    switch (m_ptr->DIO_TYPE) {
        case DIO_BYTE: 					 /* byte values */
            pvb_pairs = (pvb_pair_t *) vdevio_pv_buf;
            if (DIO_INPUT == m_ptr->DIO_REQUEST) { 
                for (i=0; i < m_ptr->DIO_VEC_SIZE; i++) 
                    pvb_pairs[i].value = inb(pvb_pairs[i].port); 
            } else { 
                for (i=0; i < m_ptr->DIO_VEC_SIZE; i++) 
                    outb(pvb_pairs[i].port, pvb_pairs[i].value); 
            } 
            break; 
        case DIO_WORD:					  /* word values */
            pvw_pairs = (pvw_pair_t *) vdevio_pv_buf;
            if (DIO_INPUT == m_ptr->DIO_REQUEST) {
                for (i=0; i < m_ptr->DIO_VEC_SIZE; i++) 
                    pvw_pairs[i].value = inw(pvw_pairs[i].port);  
            } else {
                for (i=0; i < m_ptr->DIO_VEC_SIZE; i++) 
                    outw(pvw_pairs[i].port, pvw_pairs[i].value); 
            }
            break; 
	case DIO_LONG:			/* fall through: long values */
        default:  /* only DIO_LONG can arrive here, see above switch */
            pvl_pairs = (pvl_pair_t *) vdevio_pv_buf;
            if (DIO_INPUT == m_ptr->DIO_REQUEST) { 
                for (i=0; i < m_ptr->DIO_VEC_SIZE; i++) 
                    pvl_pairs[i].value = inl(pvl_pairs[i].port);  
            } else {
                for (i=0; i < m_ptr->DIO_VEC_SIZE; i++) 
                    outl(pvb_pairs[i].port, pvl_pairs[i].value); 
            }
    }
    unlock();    
    
    /* Almost done, copy back results for input requests. */
    if (DIO_INPUT == m_ptr->REQUEST)
        phys_copy(kernel_phys, caller_phys, (phys_bytes) bytes);
    return(OK);
}