2005-04-21 16:53:53 +02:00
|
|
|
/* This task handles the interface between the kernel and user-level servers.
|
|
|
|
* System services can be accessed by doing a system call. System calls are
|
|
|
|
* transformed into request messages, which are handled by this task. By
|
|
|
|
* convention, a sys_call() is transformed in a SYS_CALL request message that
|
|
|
|
* is handled in a function named do_call().
|
|
|
|
*
|
|
|
|
* A private call vector is used to map all system calls to the functions that
|
|
|
|
* handle them. The actual handler functions are contained in separate files
|
|
|
|
* to keep this file clean. The call vector is used in the system task's main
|
|
|
|
* loop to handle all incoming requests.
|
|
|
|
*
|
|
|
|
* In addition to the main sys_task() entry point, which starts the main loop,
|
|
|
|
* there are several other minor entry points:
|
|
|
|
* cause_sig: take action to cause a signal to occur
|
|
|
|
* clear_proc: clean up a process in the process table, e.g. on exit
|
|
|
|
* umap_local: map virtual address in LOCAL_SEG to physical
|
|
|
|
* umap_remote: map virtual address in REMOTE_SEG to physical
|
|
|
|
* umap_bios: map virtual address in BIOS_SEG to physical
|
|
|
|
* numap_local: umap_local D segment from proc nr instead of pointer
|
|
|
|
* virtual_copy: copy bytes from one virtual address to another
|
2005-06-03 15:55:06 +02:00
|
|
|
* get_randomness: accumulate randomness in a buffer
|
2005-04-21 16:53:53 +02:00
|
|
|
* generic_handler: interrupt handler for user-level device drivers
|
|
|
|
*
|
|
|
|
* Changes:
|
2005-04-29 17:36:43 +02:00
|
|
|
* Apr 25, 2005 made mapping of call vector explicit (Jorrit N. Herder)
|
2005-04-21 16:53:53 +02:00
|
|
|
* Oct 29, 2004 new clear_proc() function (Jorrit N. Herder)
|
|
|
|
* Oct 17, 2004 generic handler and IRQ policies (Jorrit N. Herder)
|
|
|
|
* Oct 10, 2004 dispatch system calls from call vector (Jorrit N. Herder)
|
|
|
|
* Sep 30, 2004 source code documentation updated (Jorrit N. Herder)
|
|
|
|
* Sep 10, 2004 system call functions in library (Jorrit N. Herder)
|
2005-04-29 17:36:43 +02:00
|
|
|
* 2004 to 2005 various new syscalls (see syslib.h) (Jorrit N. Herder)
|
2005-04-21 16:53:53 +02:00
|
|
|
*/
|
|
|
|
|
|
|
|
#include "kernel.h"
|
|
|
|
#include "system.h"
|
|
|
|
#include <stdlib.h>
|
|
|
|
#include <signal.h>
|
|
|
|
#include <unistd.h>
|
|
|
|
#include <sys/sigcontext.h>
|
|
|
|
#include <sys/svrctl.h>
|
|
|
|
#include <minix/callnr.h>
|
|
|
|
#include "sendmask.h"
|
|
|
|
#if (CHIP == INTEL)
|
2005-04-29 17:36:43 +02:00
|
|
|
#include <ibm/memory.h>
|
2005-04-21 16:53:53 +02:00
|
|
|
#include "protect.h"
|
|
|
|
#endif
|
|
|
|
|
2005-04-29 17:36:43 +02:00
|
|
|
/* Declaration of the call vector that defines the mapping of system calls
|
|
|
|
* to handler functions. The vector is initialized in sys_init() with map(),
|
|
|
|
* which makes sure the system call numbers are ok. No space is allocated,
|
|
|
|
* because the dummy is declared extern. If an illegal call is given, the
|
|
|
|
* array size will be negative and this won't compile.
|
2005-04-21 16:53:53 +02:00
|
|
|
*/
|
2005-04-29 17:36:43 +02:00
|
|
|
PUBLIC int (*call_vec[NR_SYS_CALLS])(message *m_ptr);
|
2005-04-21 16:53:53 +02:00
|
|
|
|
2005-04-29 17:36:43 +02:00
|
|
|
#define map(call_nr, handler) \
|
|
|
|
{extern int dummy[NR_SYS_CALLS > (unsigned) (call_nr) ? 1 : -1];} \
|
|
|
|
call_vec[(call_nr)] = (handler)
|
|
|
|
|
|
|
|
FORWARD _PROTOTYPE( void initialize, (void));
|
2005-04-21 16:53:53 +02:00
|
|
|
|
|
|
|
|
|
|
|
/*===========================================================================*
|
|
|
|
* sys_task *
|
|
|
|
*===========================================================================*/
|
|
|
|
PUBLIC void sys_task()
|
|
|
|
{
|
|
|
|
/* Main entry point of sys_task. Get the message and dispatch on type. */
|
2005-04-29 17:36:43 +02:00
|
|
|
static message m;
|
2005-05-27 14:44:14 +02:00
|
|
|
register int result, debug;
|
2005-04-21 16:53:53 +02:00
|
|
|
|
|
|
|
/* Initialize the system task. */
|
|
|
|
initialize();
|
|
|
|
|
|
|
|
while (TRUE) {
|
|
|
|
/* Get work. */
|
|
|
|
receive(ANY, &m);
|
|
|
|
|
|
|
|
/* Handle the request. */
|
|
|
|
if ((unsigned) m.m_type < NR_SYS_CALLS) {
|
|
|
|
result = (*call_vec[m.m_type])(&m); /* do system call */
|
|
|
|
} else {
|
2005-05-26 15:17:57 +02:00
|
|
|
kprintf("Warning, illegal SYSTASK request from %d.\n", m.m_source);
|
2005-04-21 16:53:53 +02:00
|
|
|
result = EBADREQUEST; /* illegal message type */
|
|
|
|
}
|
|
|
|
|
2005-05-18 12:36:23 +02:00
|
|
|
/* Send a reply, unless inhibited by a handler function. Use the kernel
|
|
|
|
* function lock_send() to prevent a system call trap. The destination
|
|
|
|
* is known to be blocked waiting for a message.
|
|
|
|
*/
|
2005-04-21 16:53:53 +02:00
|
|
|
if (result != EDONTREPLY) {
|
2005-05-27 14:44:14 +02:00
|
|
|
debug = m.m_type;
|
2005-04-21 16:53:53 +02:00
|
|
|
m.m_type = result; /* report status of call */
|
2005-05-27 14:44:14 +02:00
|
|
|
if (OK != lock_send(m.m_source, &m)) {
|
|
|
|
kprintf("Warning, SYSTASK couldn't reply to request %d", debug);
|
|
|
|
kprintf(" from %d\n", m.m_source);
|
|
|
|
}
|
2005-04-21 16:53:53 +02:00
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/*===========================================================================*
|
|
|
|
* initialize *
|
|
|
|
*===========================================================================*/
|
|
|
|
PRIVATE void initialize(void)
|
|
|
|
{
|
|
|
|
register struct proc *rp;
|
|
|
|
int i;
|
|
|
|
|
2005-05-02 16:30:04 +02:00
|
|
|
/* Initialize IRQ handler hooks. Mark all hooks available. */
|
|
|
|
for (i=0; i<NR_IRQ_HOOKS; i++) {
|
|
|
|
irq_hooks[i].proc_nr = NONE;
|
|
|
|
}
|
2005-04-21 16:53:53 +02:00
|
|
|
|
|
|
|
/* Initialize all alarm timers for all processes. */
|
|
|
|
for (rp=BEG_PROC_ADDR; rp < END_PROC_ADDR; rp++) {
|
2005-05-31 16:43:04 +02:00
|
|
|
tmr_inittimer(&(rp->p_alarm_timer));
|
2005-04-21 16:53:53 +02:00
|
|
|
}
|
2005-04-29 17:36:43 +02:00
|
|
|
|
|
|
|
/* Initialize the call vector to a safe default handler. Some system calls
|
|
|
|
* may be disabled or nonexistant. Then explicitely map known calls to their
|
|
|
|
* handler functions. This is done with a macro that gives a compile error
|
|
|
|
* if an illegal call number is used. The ordering is not important here.
|
|
|
|
*/
|
|
|
|
for (i=0; i<NR_SYS_CALLS; i++) {
|
|
|
|
call_vec[i] = do_unused;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Process management. */
|
|
|
|
map(SYS_FORK, do_fork); /* informs kernel that a process has forked */
|
|
|
|
map(SYS_XIT, do_xit); /* informs kernel that a process has exited */
|
|
|
|
map(SYS_NEWMAP, do_newmap); /* allows PM to set up a process memory map */
|
|
|
|
map(SYS_EXEC, do_exec); /* sets program counter and stack pointer after EXEC */
|
|
|
|
map(SYS_TRACE, do_trace); /* request a trace operation */
|
|
|
|
|
|
|
|
/* Signal handling. */
|
|
|
|
map(SYS_KILL, do_kill); /* cause a process to be signaled */
|
|
|
|
map(SYS_GETSIG, do_getsig); /* PM checks for pending signals */
|
|
|
|
map(SYS_ENDSIG, do_endsig); /* PM finished processing signal */
|
|
|
|
map(SYS_SIGSEND, do_sigsend); /* start POSIX-style signal */
|
|
|
|
map(SYS_SIGRETURN, do_sigreturn); /* return from POSIX-style signal */
|
|
|
|
|
|
|
|
/* Clock functionality. */
|
|
|
|
map(SYS_TIMES, do_times); /* get uptime and process times */
|
|
|
|
map(SYS_SIGNALRM, do_signalrm); /* causes an alarm signal */
|
|
|
|
map(SYS_SYNCALRM, do_syncalrm); /* send a notification message */
|
|
|
|
|
|
|
|
/* Device I/O. */
|
|
|
|
map(SYS_IRQCTL, do_irqctl); /* interrupt control operations */
|
|
|
|
map(SYS_DEVIO, do_devio); /* inb, inw, inl, outb, outw, outl */
|
|
|
|
map(SYS_SDEVIO, do_sdevio); /* phys_insb, _insw, _outsb, _outsw */
|
|
|
|
map(SYS_VDEVIO, do_vdevio); /* vector with devio requests */
|
|
|
|
|
|
|
|
/* Server and driver control. */
|
|
|
|
map(SYS_SEGCTL, do_segctl); /* add segment and get selector */
|
|
|
|
map(SYS_IOPENABLE, do_iopenable); /* enable CPU I/O protection bits */
|
|
|
|
map(SYS_SVRCTL, do_svrctl); /* kernel control functions */
|
|
|
|
map(SYS_EXIT, do_exit); /* exit a system process*/
|
|
|
|
|
|
|
|
/* Copying. */
|
|
|
|
map(SYS_UMAP, do_umap); /* map virtual to physical address */
|
2005-05-02 16:30:04 +02:00
|
|
|
map(SYS_VIRCOPY, do_vircopy); /* use pure virtual addressing */
|
2005-04-29 17:36:43 +02:00
|
|
|
map(SYS_PHYSCOPY, do_physcopy); /* use physical addressing */
|
2005-06-01 11:37:52 +02:00
|
|
|
map(SYS_PHYSZERO, do_physzero); /* zero physical memory region */
|
2005-04-29 17:36:43 +02:00
|
|
|
map(SYS_VIRVCOPY, do_virvcopy); /* vector with copy requests */
|
2005-05-10 13:06:24 +02:00
|
|
|
map(SYS_PHYSVCOPY, do_physvcopy); /* vector with copy requests */
|
2005-04-29 17:36:43 +02:00
|
|
|
|
|
|
|
/* Miscellaneous. */
|
|
|
|
map(SYS_ABORT, do_abort); /* abort MINIX */
|
|
|
|
map(SYS_GETINFO, do_getinfo); /* request system information */
|
2005-04-21 16:53:53 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
/*===========================================================================*
|
|
|
|
* clear_proc *
|
|
|
|
*===========================================================================*/
|
|
|
|
PUBLIC void clear_proc(proc_nr)
|
|
|
|
int proc_nr; /* slot of process to clean up */
|
|
|
|
{
|
|
|
|
register struct proc *rp, *rc;
|
2005-05-26 15:17:57 +02:00
|
|
|
#if DEAD_CODE
|
2005-04-21 16:53:53 +02:00
|
|
|
struct proc *np, *xp;
|
2005-05-26 15:17:57 +02:00
|
|
|
#else
|
|
|
|
register struct proc **xpp; /* iterate over caller queue */
|
|
|
|
#endif
|
2005-05-30 13:05:42 +02:00
|
|
|
int i;
|
2005-04-21 16:53:53 +02:00
|
|
|
|
|
|
|
/* Get a pointer to the process that exited. */
|
|
|
|
rc = proc_addr(proc_nr);
|
|
|
|
|
|
|
|
/* Turn off any alarm timers at the clock. */
|
2005-05-31 16:43:04 +02:00
|
|
|
reset_timer(&rc->p_alarm_timer);
|
2005-04-21 16:53:53 +02:00
|
|
|
|
|
|
|
/* Make sure the exiting process is no longer scheduled. */
|
|
|
|
if (rc->p_flags == 0) lock_unready(rc);
|
|
|
|
|
|
|
|
/* If the process being terminated happens to be queued trying to send a
|
|
|
|
* message (e.g., the process was killed by a signal, rather than it doing
|
|
|
|
* an exit or it is forcibly shutdown in the stop sequence), then it must
|
|
|
|
* be removed from the message queues.
|
|
|
|
*/
|
|
|
|
if (rc->p_flags & SENDING) {
|
|
|
|
/* Check all proc slots to see if the exiting process is queued. */
|
|
|
|
for (rp = BEG_PROC_ADDR; rp < END_PROC_ADDR; rp++) {
|
2005-05-19 16:05:51 +02:00
|
|
|
if (rp->p_caller_q == NIL_PROC) continue;
|
2005-05-26 15:17:57 +02:00
|
|
|
#if DEAD_CODE
|
2005-05-19 16:05:51 +02:00
|
|
|
if (rp->p_caller_q == rc) {
|
2005-04-21 16:53:53 +02:00
|
|
|
/* Exiting process is on front of this queue. */
|
2005-05-26 15:17:57 +02:00
|
|
|
rp->p_caller_q = rc->p_q_link;
|
2005-04-21 16:53:53 +02:00
|
|
|
break;
|
|
|
|
} else {
|
|
|
|
/* See if exiting process is in middle of queue. */
|
2005-05-19 16:05:51 +02:00
|
|
|
np = rp->p_caller_q;
|
2005-05-26 15:17:57 +02:00
|
|
|
while ( ( xp = np->p_q_link) != NIL_PROC) {
|
2005-04-21 16:53:53 +02:00
|
|
|
if (xp == rc) {
|
2005-05-26 15:17:57 +02:00
|
|
|
np->p_q_link = xp->p_q_link;
|
2005-04-21 16:53:53 +02:00
|
|
|
break;
|
|
|
|
} else {
|
|
|
|
np = xp;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
2005-05-26 15:17:57 +02:00
|
|
|
#else
|
|
|
|
/* Make sure that the exiting process is not on the queue. */
|
|
|
|
xpp = &rp->p_caller_q;
|
|
|
|
while (*xpp != NIL_PROC) { /* check entire queue */
|
|
|
|
if (*xpp == rc) { /* process is on the queue */
|
|
|
|
*xpp = (*xpp)->p_q_link; /* replace by next process */
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
xpp = &(*xpp)->p_q_link; /* proceed to next queued */
|
|
|
|
}
|
|
|
|
#endif
|
2005-04-21 16:53:53 +02:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2005-05-30 13:05:42 +02:00
|
|
|
/* Check the table with IRQ hooks to see if hooks should be released. */
|
|
|
|
for (i=0; i < NR_IRQ_HOOKS; i++) {
|
|
|
|
if (irq_hooks[i].proc_nr == proc_nr)
|
|
|
|
irq_hooks[i].proc_nr = NONE;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Check if there are pending notifications. Release the buffers. */
|
|
|
|
while (rc->p_ntf_q != NULL) {
|
|
|
|
i = (int) (rc->p_ntf_q - ¬ify_buffer[0]);
|
|
|
|
free_bit(i, notify_bitmap, NR_NOTIFY_BUFS);
|
|
|
|
rc->p_ntf_q = rc->p_ntf_q->n_next;
|
|
|
|
}
|
|
|
|
|
2005-04-21 16:53:53 +02:00
|
|
|
/* Now clean up the process table entry. Reset to defaults. */
|
2005-05-31 11:50:51 +02:00
|
|
|
kstrncpy(rc->p_name, "<none>", P_NAME_LEN); /* unset name */
|
2005-04-21 16:53:53 +02:00
|
|
|
sigemptyset(&rc->p_pending); /* remove pending signals */
|
|
|
|
rc->p_pendcount = 0; /* all signals are gone */
|
|
|
|
rc->p_flags = 0; /* remove all flags */
|
|
|
|
rc->p_type = P_NONE; /* announce slot empty */
|
|
|
|
rc->p_sendmask = DENY_ALL_MASK; /* set most restrictive mask */
|
|
|
|
|
|
|
|
#if (CHIP == M68000)
|
|
|
|
pmmu_delete(rc); /* we're done, remove tables */
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
|
|
|
|
2005-06-03 15:55:06 +02:00
|
|
|
/*===========================================================================*
|
|
|
|
* get_randomness *
|
|
|
|
*===========================================================================*/
|
|
|
|
PUBLIC void get_randomness()
|
|
|
|
{
|
|
|
|
/* Gather random information with help of the CPU's cycle counter. Only use
|
|
|
|
* the lowest bytes because the highest bytes won't differ that much.
|
|
|
|
*/
|
|
|
|
unsigned long tsc_high;
|
|
|
|
read_tsc(&tsc_high, &krandom.r_buf[krandom.r_next]);
|
|
|
|
if (krandom.r_size < RANDOM_ELEMENTS) krandom.r_size ++;
|
|
|
|
krandom.r_next = (krandom.r_next + 1 ) % RANDOM_ELEMENTS;
|
|
|
|
}
|
|
|
|
|
2005-04-21 16:53:53 +02:00
|
|
|
|
|
|
|
/*===========================================================================*
|
|
|
|
* generic_handler *
|
|
|
|
*===========================================================================*/
|
|
|
|
PUBLIC int generic_handler(hook)
|
|
|
|
irq_hook_t *hook;
|
|
|
|
{
|
2005-05-12 18:06:37 +02:00
|
|
|
/* This function handles hardware interrupt in a simple and generic way. All
|
2005-04-29 17:36:43 +02:00
|
|
|
* interrupts are transformed into messages to a driver. The IRQ line will be
|
|
|
|
* reenabled if the policy says so.
|
2005-06-03 15:55:06 +02:00
|
|
|
* In addition, the interrupt handler gathers random information in a buffer
|
|
|
|
* by timestamping the interrupts.
|
2005-04-29 17:36:43 +02:00
|
|
|
*/
|
2005-05-24 12:06:17 +02:00
|
|
|
message m;
|
2005-06-03 15:55:06 +02:00
|
|
|
|
|
|
|
/* Gather random information. */
|
|
|
|
get_randomness();
|
|
|
|
|
|
|
|
/* Build notification message and return. */
|
2005-05-24 12:06:17 +02:00
|
|
|
m.NOTIFY_TYPE = HARD_INT;
|
|
|
|
m.NOTIFY_ARG = hook->irq;
|
2005-06-17 15:00:04 +02:00
|
|
|
lock_notify(hook->proc_nr, &m);
|
2005-05-02 16:30:04 +02:00
|
|
|
return(hook->policy & IRQ_REENABLE);
|
2005-04-21 16:53:53 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/*===========================================================================*
|
|
|
|
* cause_sig *
|
|
|
|
*===========================================================================*/
|
|
|
|
PUBLIC void cause_sig(proc_nr, sig_nr)
|
|
|
|
int proc_nr; /* process to be signalled */
|
|
|
|
int sig_nr; /* signal to be sent, 1 to _NSIG */
|
|
|
|
{
|
2005-06-17 11:09:54 +02:00
|
|
|
/* A system process wants to send a signal to a process. Examples are:
|
2005-04-21 16:53:53 +02:00
|
|
|
* TTY wanting to cause SIGINT upon getting a DEL
|
|
|
|
* CLOCK wanting to cause SIGALRM when timer expires
|
2005-06-17 11:09:54 +02:00
|
|
|
* FS wanting to cause SIGPIPE for a broken pipe
|
|
|
|
* Signals are handled by sending a message to PM. This function handles the
|
2005-04-29 17:36:43 +02:00
|
|
|
* signals and makes sure the PM gets them by sending a notification. The
|
|
|
|
* process being signaled is blocked while PM has not finished all signals
|
2005-04-21 16:53:53 +02:00
|
|
|
* for it. These signals are counted in p_pendcount, and the SIG_PENDING
|
|
|
|
* flag is kept nonzero while there are some. It is not sufficient to ready
|
2005-04-29 17:36:43 +02:00
|
|
|
* the process when PM is informed, because PM can block waiting for FS to
|
2005-04-21 16:53:53 +02:00
|
|
|
* do a core dump.
|
|
|
|
*/
|
|
|
|
register struct proc *rp, *mmp;
|
2005-05-24 12:06:17 +02:00
|
|
|
message m;
|
2005-04-21 16:53:53 +02:00
|
|
|
|
|
|
|
rp = proc_addr(proc_nr);
|
|
|
|
if (sigismember(&rp->p_pending, sig_nr))
|
|
|
|
return; /* this signal already pending */
|
|
|
|
sigaddset(&rp->p_pending, sig_nr);
|
|
|
|
++rp->p_pendcount; /* count new signal pending */
|
|
|
|
if (rp->p_flags & PENDING)
|
|
|
|
return; /* another signal already pending */
|
|
|
|
if (rp->p_flags == 0) lock_unready(rp);
|
|
|
|
rp->p_flags |= PENDING | SIG_PENDING;
|
2005-05-24 12:06:17 +02:00
|
|
|
m.NOTIFY_TYPE = KSIG_PENDING;
|
|
|
|
m.NOTIFY_ARG = 0;
|
|
|
|
m.NOTIFY_FLAGS = 0;
|
2005-05-24 16:35:58 +02:00
|
|
|
lock_notify(PM_PROC_NR, &m);
|
2005-04-21 16:53:53 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/*===========================================================================*
|
2005-05-24 12:06:17 +02:00
|
|
|
* umap_bios *
|
2005-04-21 16:53:53 +02:00
|
|
|
*===========================================================================*/
|
|
|
|
PUBLIC phys_bytes umap_bios(rp, vir_addr, bytes)
|
|
|
|
register struct proc *rp; /* pointer to proc table entry for process */
|
|
|
|
vir_bytes vir_addr; /* virtual address in BIOS segment */
|
|
|
|
vir_bytes bytes; /* # of bytes to be copied */
|
|
|
|
{
|
2005-04-29 17:36:43 +02:00
|
|
|
/* Calculate the physical memory address at the BIOS. Note: currently, BIOS
|
|
|
|
* address zero (the first BIOS interrupt vector) is not considered, as an
|
|
|
|
* error here, but since the physical address will be zero as well, the
|
|
|
|
* calling function will think an error occurred. This is not a problem,
|
|
|
|
* since no one uses the first BIOS interrupt vector.
|
|
|
|
*/
|
2005-04-21 16:53:53 +02:00
|
|
|
phys_bytes phys_addr;
|
|
|
|
|
2005-04-29 17:36:43 +02:00
|
|
|
/* Check all acceptable ranges. */
|
2005-06-06 13:54:58 +02:00
|
|
|
#if 0
|
2005-04-29 17:36:43 +02:00
|
|
|
if (vir_addr >= BIOS_MEM_BEGIN && vir_addr + bytes <= BIOS_MEM_END)
|
|
|
|
return (phys_bytes) vir_addr;
|
|
|
|
else if (vir_addr >= UPPER_MEM_BEGIN && vir_addr + bytes <= UPPER_MEM_END)
|
|
|
|
return (phys_bytes) vir_addr;
|
2005-06-06 13:54:58 +02:00
|
|
|
#else
|
|
|
|
if (vir_addr >= BIOS_MEM_BEGIN && vir_addr + bytes <= UPPER_MEM_END)
|
|
|
|
return (phys_bytes) vir_addr;
|
|
|
|
#endif
|
2005-04-21 16:53:53 +02:00
|
|
|
|
2005-04-29 17:36:43 +02:00
|
|
|
kprintf("Warning, error in umap_bios, virtual address 0x%x\n", vir_addr);
|
|
|
|
return 0;
|
2005-04-21 16:53:53 +02:00
|
|
|
}
|
|
|
|
|
2005-05-24 14:30:29 +02:00
|
|
|
|
2005-04-21 16:53:53 +02:00
|
|
|
/*===========================================================================*
|
|
|
|
* umap_local *
|
|
|
|
*===========================================================================*/
|
|
|
|
PUBLIC phys_bytes umap_local(rp, seg, vir_addr, bytes)
|
|
|
|
register struct proc *rp; /* pointer to proc table entry for process */
|
|
|
|
int seg; /* T, D, or S segment */
|
|
|
|
vir_bytes vir_addr; /* virtual address in bytes within the seg */
|
|
|
|
vir_bytes bytes; /* # of bytes to be copied */
|
|
|
|
{
|
|
|
|
/* Calculate the physical memory address for a given virtual address. */
|
|
|
|
|
|
|
|
vir_clicks vc; /* the virtual address in clicks */
|
|
|
|
phys_bytes pa; /* intermediate variables as phys_bytes */
|
|
|
|
#if (CHIP == INTEL)
|
|
|
|
phys_bytes seg_base;
|
|
|
|
#endif
|
|
|
|
|
|
|
|
/* If 'seg' is D it could really be S and vice versa. T really means T.
|
|
|
|
* If the virtual address falls in the gap, it causes a problem. On the
|
|
|
|
* 8088 it is probably a legal stack reference, since "stackfaults" are
|
|
|
|
* not detected by the hardware. On 8088s, the gap is called S and
|
|
|
|
* accepted, but on other machines it is called D and rejected.
|
|
|
|
* The Atari ST behaves like the 8088 in this respect.
|
|
|
|
*/
|
|
|
|
|
|
|
|
if (bytes <= 0) return( (phys_bytes) 0);
|
2005-05-24 14:30:29 +02:00
|
|
|
if (vir_addr + bytes <= vir_addr) return 0; /* overflow */
|
2005-04-21 16:53:53 +02:00
|
|
|
vc = (vir_addr + bytes - 1) >> CLICK_SHIFT; /* last click of data */
|
|
|
|
|
|
|
|
#if (CHIP == INTEL) || (CHIP == M68000)
|
|
|
|
if (seg != T)
|
|
|
|
seg = (vc < rp->p_memmap[D].mem_vir + rp->p_memmap[D].mem_len ? D : S);
|
|
|
|
#else
|
|
|
|
if (seg != T)
|
|
|
|
seg = (vc < rp->p_memmap[S].mem_vir ? D : S);
|
|
|
|
#endif
|
|
|
|
|
|
|
|
if((vir_addr>>CLICK_SHIFT) >= rp->p_memmap[seg].mem_vir +
|
|
|
|
rp->p_memmap[seg].mem_len) return( (phys_bytes) 0 );
|
2005-05-24 14:30:29 +02:00
|
|
|
|
|
|
|
if(vc >= rp->p_memmap[seg].mem_vir +
|
|
|
|
rp->p_memmap[seg].mem_len) return( (phys_bytes) 0 );
|
|
|
|
|
2005-04-21 16:53:53 +02:00
|
|
|
#if (CHIP == INTEL)
|
|
|
|
seg_base = (phys_bytes) rp->p_memmap[seg].mem_phys;
|
|
|
|
seg_base = seg_base << CLICK_SHIFT; /* segment origin in bytes */
|
|
|
|
#endif
|
|
|
|
pa = (phys_bytes) vir_addr;
|
|
|
|
#if (CHIP != M68000)
|
|
|
|
pa -= rp->p_memmap[seg].mem_vir << CLICK_SHIFT;
|
|
|
|
return(seg_base + pa);
|
|
|
|
#endif
|
|
|
|
#if (CHIP == M68000)
|
|
|
|
pa -= (phys_bytes)rp->p_memmap[seg].mem_vir << CLICK_SHIFT;
|
|
|
|
pa += (phys_bytes)rp->p_memmap[seg].mem_phys << CLICK_SHIFT;
|
|
|
|
return(pa);
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
|
|
|
/*==========================================================================*
|
|
|
|
* numap_local *
|
|
|
|
*==========================================================================*/
|
|
|
|
PUBLIC phys_bytes numap_local(proc_nr, vir_addr, bytes)
|
|
|
|
int proc_nr; /* process number to be mapped */
|
|
|
|
vir_bytes vir_addr; /* virtual address in bytes within D seg */
|
|
|
|
vir_bytes bytes; /* # of bytes required in segment */
|
|
|
|
{
|
|
|
|
/* Do umap_local() starting from a process number instead of a pointer.
|
|
|
|
* This function is used by device drivers, so they need not know about the
|
|
|
|
* process table. To save time, there is no 'seg' parameter. The segment
|
|
|
|
* is always D.
|
|
|
|
*/
|
|
|
|
return(umap_local(proc_addr(proc_nr), D, vir_addr, bytes));
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/*===========================================================================*
|
|
|
|
* umap_remote *
|
|
|
|
*===========================================================================*/
|
|
|
|
PUBLIC phys_bytes umap_remote(rp, seg, vir_addr, bytes)
|
|
|
|
register struct proc *rp; /* pointer to proc table entry for process */
|
|
|
|
int seg; /* index of remote segment */
|
|
|
|
vir_bytes vir_addr; /* virtual address in bytes within the seg */
|
|
|
|
vir_bytes bytes; /* # of bytes to be copied */
|
|
|
|
{
|
|
|
|
/* Calculate the physical memory address for a given virtual address. */
|
2005-04-29 17:36:43 +02:00
|
|
|
struct far_mem *fm;
|
2005-04-21 16:53:53 +02:00
|
|
|
|
2005-04-29 17:36:43 +02:00
|
|
|
if (bytes <= 0) return( (phys_bytes) 0);
|
|
|
|
if (seg < 0 || seg >= NR_REMOTE_SEGS) return( (phys_bytes) 0);
|
2005-04-21 16:53:53 +02:00
|
|
|
|
2005-04-29 17:36:43 +02:00
|
|
|
fm = &rp->p_farmem[seg];
|
|
|
|
if (! fm->in_use) return( (phys_bytes) 0);
|
|
|
|
if (vir_addr + bytes > fm->mem_len) return( (phys_bytes) 0);
|
|
|
|
|
|
|
|
return(fm->mem_phys + (phys_bytes) vir_addr);
|
2005-04-21 16:53:53 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
/*==========================================================================*
|
|
|
|
* virtual_copy *
|
|
|
|
*==========================================================================*/
|
|
|
|
PUBLIC int virtual_copy(src_addr, dst_addr, bytes)
|
|
|
|
struct vir_addr *src_addr; /* source virtual address */
|
|
|
|
struct vir_addr *dst_addr; /* destination virtual address */
|
|
|
|
vir_bytes bytes; /* # of bytes to copy */
|
|
|
|
{
|
|
|
|
/* Copy bytes from virtual address src_addr to virtual address dst_addr.
|
2005-04-29 17:36:43 +02:00
|
|
|
* Virtual addresses can be in ABS, LOCAL_SEG, REMOTE_SEG, or BIOS_SEG.
|
2005-04-21 16:53:53 +02:00
|
|
|
*/
|
|
|
|
struct vir_addr *vir_addr[2]; /* virtual source and destination address */
|
|
|
|
phys_bytes phys_addr[2]; /* absolute source and destination */
|
|
|
|
int seg_index;
|
|
|
|
int i;
|
|
|
|
|
|
|
|
/* Check copy count. */
|
|
|
|
if (bytes <= 0) {
|
2005-06-17 11:09:54 +02:00
|
|
|
kprintf("v_cp: copy count problem <= 0\n", NO_NUM);
|
2005-04-21 16:53:53 +02:00
|
|
|
return(EDOM);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Do some more checks and map virtual addresses to physical addresses. */
|
|
|
|
vir_addr[_SRC_] = src_addr;
|
|
|
|
vir_addr[_DST_] = dst_addr;
|
|
|
|
for (i=_SRC_; i<=_DST_; i++) {
|
|
|
|
|
|
|
|
/* Get physical address. */
|
|
|
|
switch((vir_addr[i]->segment & SEGMENT_TYPE)) {
|
|
|
|
case LOCAL_SEG:
|
|
|
|
seg_index = vir_addr[i]->segment & SEGMENT_INDEX;
|
|
|
|
phys_addr[i] = umap_local( proc_addr(vir_addr[i]->proc_nr),
|
|
|
|
seg_index, vir_addr[i]->offset, bytes );
|
|
|
|
break;
|
|
|
|
case REMOTE_SEG:
|
|
|
|
seg_index = vir_addr[i]->segment & SEGMENT_INDEX;
|
|
|
|
phys_addr[i] = umap_remote( proc_addr(vir_addr[i]->proc_nr),
|
|
|
|
seg_index, vir_addr[i]->offset, bytes );
|
|
|
|
break;
|
|
|
|
case BIOS_SEG:
|
|
|
|
phys_addr[i] = umap_bios( proc_addr(vir_addr[i]->proc_nr),
|
|
|
|
vir_addr[i]->offset, bytes );
|
|
|
|
break;
|
2005-04-29 17:36:43 +02:00
|
|
|
case PHYS_SEG:
|
|
|
|
phys_addr[i] = vir_addr[i]->offset;
|
|
|
|
break;
|
2005-04-21 16:53:53 +02:00
|
|
|
default:
|
|
|
|
kprintf("v_cp: Unknown segment type: %d\n",
|
|
|
|
vir_addr[i]->segment & SEGMENT_TYPE);
|
|
|
|
return(EINVAL);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Check if mapping succeeded. */
|
2005-04-29 17:36:43 +02:00
|
|
|
if (phys_addr[i] <= 0 && vir_addr[i]->segment != PHYS_SEG) {
|
2005-06-17 11:09:54 +02:00
|
|
|
kprintf("v_cp: Mapping failed ... phys <= 0\n", NO_NUM);
|
2005-04-21 16:53:53 +02:00
|
|
|
return(EFAULT);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Now copy bytes between physical addresseses. */
|
|
|
|
phys_copy(phys_addr[_SRC_], phys_addr[_DST_], (phys_bytes) bytes);
|
|
|
|
return(OK);
|
|
|
|
}
|
|
|
|
|
|
|
|
|