minix/drivers/memory/memory.c

415 lines
12 KiB
C
Raw Normal View History

2005-04-21 16:53:53 +02:00
/* This file contains the device dependent part of the drivers for the
* following special files:
* /dev/ram - RAM disk
* /dev/mem - absolute memory
* /dev/kmem - kernel virtual memory
* /dev/null - null device (data sink)
2005-04-29 17:36:43 +02:00
* /dev/boot - boot device loaded from boot image
* /dev/zero - null byte stream generator
2005-04-21 16:53:53 +02:00
*
* Changes:
2005-04-29 17:36:43 +02:00
* Apr 29, 2005 added null byte generator (Jorrit N. Herder)
* Apr 09, 2005 added support for boot device (Jorrit N. Herder)
2005-04-21 16:53:53 +02:00
* Jul 26, 2004 moved RAM driver to user-space (Jorrit N. Herder)
* Apr 20, 1992 device dependent/independent split (Kees J. Bot)
*/
#include "../drivers.h"
#include "../libdriver/driver.h"
#include <sys/ioc_memory.h>
#include <env.h>
#include <minix/ds.h>
#include <minix/vm.h>
#include <sys/mman.h>
#include "../../kernel/const.h"
#include "../../kernel/config.h"
#include "../../kernel/type.h"
2005-04-21 16:53:53 +02:00
2005-09-30 14:57:30 +02:00
#include <sys/vm.h>
#include <sys/vm_i386.h>
2005-09-30 14:57:30 +02:00
2005-07-18 17:40:24 +02:00
#include "assert.h"
#include "local.h"
#define NR_DEVS 7 /* number of minor devices */
2005-04-21 16:53:53 +02:00
2005-04-29 17:36:43 +02:00
PRIVATE struct device m_geom[NR_DEVS]; /* base and size of each device */
PRIVATE vir_bytes m_vaddrs[NR_DEVS];
2005-04-21 16:53:53 +02:00
PRIVATE int m_device; /* current device */
PRIVATE struct kinfo kinfo; /* kernel information */
extern int errno; /* error number for PM calls */
2005-04-21 16:53:53 +02:00
2005-09-11 19:09:11 +02:00
FORWARD _PROTOTYPE( char *m_name, (void) );
FORWARD _PROTOTYPE( struct device *m_prepare, (int device) );
FORWARD _PROTOTYPE( int m_transfer, (int proc_nr, int opcode, u64_t position,
2006-06-20 10:56:15 +02:00
iovec_t *iov, unsigned nr_req, int safe));
2005-09-11 19:09:11 +02:00
FORWARD _PROTOTYPE( int m_do_open, (struct driver *dp, message *m_ptr) );
2005-04-21 16:53:53 +02:00
FORWARD _PROTOTYPE( void m_init, (void) );
2006-06-20 10:56:15 +02:00
FORWARD _PROTOTYPE( int m_ioctl, (struct driver *dp, message *m_ptr, int safe));
2005-09-11 19:09:11 +02:00
FORWARD _PROTOTYPE( void m_geometry, (struct partition *entry) );
2005-04-21 16:53:53 +02:00
/* Entry points to this driver. */
PRIVATE struct driver m_dtab = {
m_name, /* current device's name */
m_do_open, /* open or mount */
do_nop, /* nothing on a close */
m_ioctl, /* specify ram disk geometry */
m_prepare, /* prepare for I/O on a given minor device */
m_transfer, /* do the I/O */
nop_cleanup, /* no need to clean up */
m_geometry, /* memory device "geometry" */
nop_signal, /* system signals */
2005-08-03 17:22:41 +02:00
nop_alarm,
nop_cancel,
nop_select,
NULL,
NULL
2005-04-21 16:53:53 +02:00
};
2005-04-29 17:36:43 +02:00
/* Buffer for the /dev/zero null byte feed. */
#define ZERO_BUF_SIZE 1024
PRIVATE char dev_zero[ZERO_BUF_SIZE];
2005-04-29 17:36:43 +02:00
#define click_to_round_k(n) \
((unsigned) ((((unsigned long) (n) << CLICK_SHIFT) + 512) / 1024))
2005-04-21 16:53:53 +02:00
/*===========================================================================*
* main *
*===========================================================================*/
2005-08-25 14:35:59 +02:00
PUBLIC int main(void)
2005-04-21 16:53:53 +02:00
{
/* Main program. Initialize the memory driver and start the main loop. */
struct sigaction sa;
sa.sa_handler = SIG_MESS;
sigemptyset(&sa.sa_mask);
sa.sa_flags = 0;
if (sigaction(SIGTERM,&sa,NULL)<0) panic("MEM","sigaction failed", errno);
m_init();
driver_task(&m_dtab);
2005-08-25 14:35:59 +02:00
return(OK);
2005-04-21 16:53:53 +02:00
}
/*===========================================================================*
* m_name *
*===========================================================================*/
PRIVATE char *m_name()
{
/* Return a name for the current device. */
static char name[] = "memory";
return name;
}
/*===========================================================================*
* m_prepare *
*===========================================================================*/
PRIVATE struct device *m_prepare(device)
int device;
{
/* Prepare for I/O on a device: check if the minor device number is ok. */
if (device < 0 || device >= NR_DEVS) return(NIL_DEV);
m_device = device;
return(&m_geom[device]);
}
/*===========================================================================*
* m_transfer *
*===========================================================================*/
PRIVATE int m_transfer(proc_nr, opcode, pos64, iov, nr_req, safe)
2005-04-21 16:53:53 +02:00
int proc_nr; /* process doing the request */
int opcode; /* DEV_GATHER_S or DEV_SCATTER_S */
u64_t pos64; /* offset on device to read or write */
2005-04-21 16:53:53 +02:00
iovec_t *iov; /* pointer to read or write request vector */
unsigned nr_req; /* length of request vector */
2006-06-20 10:56:15 +02:00
int safe; /* safe copies */
2005-04-21 16:53:53 +02:00
{
/* Read or write one the driver's minor devices. */
2005-04-29 17:36:43 +02:00
unsigned count, left, chunk;
2006-06-20 10:56:15 +02:00
vir_bytes user_vir, vir_offset = 0;
2005-04-21 16:53:53 +02:00
struct device *dv;
unsigned long dv_size;
2006-06-20 10:56:15 +02:00
int s, r;
off_t position;
vir_bytes dev_vaddr;
2006-06-20 10:56:15 +02:00
if(!safe) {
printf("m_transfer: unsafe?\n");
return EPERM;
}
/* ZERO_DEV and NULL_DEV are infinite in size. */
if (m_device != ZERO_DEV && m_device != NULL_DEV && ex64hi(pos64) != 0)
return OK; /* Beyond EOF */
position= cv64ul(pos64);
2005-04-21 16:53:53 +02:00
/* Get minor device number and check for /dev/null. */
dv = &m_geom[m_device];
2005-04-21 16:53:53 +02:00
dv_size = cv64ul(dv->dv_size);
dev_vaddr = m_vaddrs[m_device];
2005-04-21 16:53:53 +02:00
while (nr_req > 0) {
2005-04-29 17:36:43 +02:00
/* How much to transfer and where to / from. */
2005-04-21 16:53:53 +02:00
count = iov->iov_size;
user_vir = iov->iov_addr;
switch (m_device) {
2005-04-29 17:36:43 +02:00
/* No copying; ignore request. */
2005-04-21 16:53:53 +02:00
case NULL_DEV:
if (opcode == DEV_GATHER_S) return(OK); /* always at EOF */
2005-04-21 16:53:53 +02:00
break;
/* Virtual copying. For RAM disk, kernel memory and internal FS. */
2005-04-29 17:36:43 +02:00
case KMEM_DEV:
case RAM_DEV:
case IMGRD_DEV:
if(!dev_vaddr || dev_vaddr == (vir_bytes) MAP_FAILED) {
printf("MEM: dev %d not initialized\n", m_device);
return EIO;
}
2005-04-29 17:36:43 +02:00
if (position >= dv_size) return(OK); /* check for EOF */
if (position + count > dv_size) count = dv_size - position;
if (opcode == DEV_GATHER_S) { /* copy actual data */
2006-06-20 10:56:15 +02:00
r=sys_safecopyto(proc_nr, user_vir, vir_offset,
dev_vaddr + position, count, D);
2005-04-29 17:36:43 +02:00
} else {
2006-06-20 10:56:15 +02:00
r=sys_safecopyfrom(proc_nr, user_vir, vir_offset,
dev_vaddr + position, count, D);
2006-06-20 10:56:15 +02:00
}
if(r != OK) {
panic("MEM","I/O copy failed",r);
2005-04-29 17:36:43 +02:00
}
break;
/* Physical copying. Only used to access entire memory.
* Transfer one 'page window' at a time.
*/
2005-04-29 17:36:43 +02:00
case MEM_DEV:
{
u32_t pagestart, page_off;
static u32_t pagestart_mapped;
static int any_mapped = 0;
static char *vaddr;
int r;
u32_t subcount;
phys_bytes mem_phys;
if (position >= dv_size)
return(OK); /* check for EOF */
if (position + count > dv_size)
count = dv_size - position;
mem_phys = position;
page_off = mem_phys % I386_PAGE_SIZE;
pagestart = mem_phys - page_off;
/* All memory to the map call has to be page-aligned.
* Don't have to map same page over and over.
*/
if(!any_mapped || pagestart_mapped != pagestart) {
if(any_mapped) {
if(vm_unmap_phys(SELF, vaddr, I386_PAGE_SIZE) != OK)
panic("MEM","vm_unmap_phys failed",NO_NUM);
any_mapped = 0;
}
vaddr = vm_map_phys(SELF, (void *) pagestart, I386_PAGE_SIZE);
if(vaddr == MAP_FAILED)
r = ENOMEM;
else
r = OK;
if(r != OK) {
printf("memory: vm_map_phys failed\n");
return r;
}
any_mapped = 1;
pagestart_mapped = pagestart;
}
/* how much to be done within this page. */
subcount = I386_PAGE_SIZE-page_off;
if(subcount > count)
subcount = count;
2005-04-21 16:53:53 +02:00
if (opcode == DEV_GATHER_S) { /* copy data */
s=sys_safecopyto(proc_nr, user_vir,
vir_offset, (vir_bytes) vaddr+page_off, subcount, D);
2005-04-21 16:53:53 +02:00
} else {
s=sys_safecopyfrom(proc_nr, user_vir,
vir_offset, (vir_bytes) vaddr+page_off, subcount, D);
2005-04-21 16:53:53 +02:00
}
if(s != OK)
return s;
count = subcount;
2005-04-29 17:36:43 +02:00
break;
}
2005-04-29 17:36:43 +02:00
/* Null byte stream generator. */
case ZERO_DEV:
if (opcode == DEV_GATHER_S) {
2006-06-20 10:56:15 +02:00
size_t suboffset = 0;
2005-04-29 17:36:43 +02:00
left = count;
while (left > 0) {
chunk = (left > ZERO_BUF_SIZE) ? ZERO_BUF_SIZE : left;
2006-06-20 10:56:15 +02:00
s=sys_safecopyto(proc_nr, user_vir,
vir_offset+suboffset, (vir_bytes) dev_zero, chunk, D);
if(s != OK)
report("MEM","sys_safecopyto failed", s);
2005-04-29 17:36:43 +02:00
left -= chunk;
2006-06-20 10:56:15 +02:00
suboffset += chunk;
2005-04-29 17:36:43 +02:00
}
}
break;
/* Unknown (illegal) minor device. */
default:
return(EINVAL);
2005-04-21 16:53:53 +02:00
}
/* Book the number of bytes transferred. */
position += count;
2006-06-20 10:56:15 +02:00
vir_offset += count;
if ((iov->iov_size -= count) == 0) { iov++; nr_req--; vir_offset = 0; }
2005-04-29 17:36:43 +02:00
2005-04-21 16:53:53 +02:00
}
return(OK);
}
2005-09-11 19:09:11 +02:00
/*===========================================================================*
* m_do_open *
*===========================================================================*/
2005-04-21 16:53:53 +02:00
PRIVATE int m_do_open(dp, m_ptr)
struct driver *dp;
message *m_ptr;
{
int r;
2005-10-20 22:26:02 +02:00
/* Check device number on open. */
2005-04-21 16:53:53 +02:00
if (m_prepare(m_ptr->DEVICE) == NIL_DEV) return(ENXIO);
if (m_device == MEM_DEV)
{
r = sys_enable_iop(m_ptr->IO_ENDPT);
if (r != OK)
{
printf("m_do_open: sys_enable_iop failed for %d: %d\n",
m_ptr->IO_ENDPT, r);
return r;
}
}
2005-04-21 16:53:53 +02:00
return(OK);
}
/*===========================================================================*
* m_init *
*===========================================================================*/
PRIVATE void m_init()
{
2005-04-29 17:36:43 +02:00
/* Initialize this task. All minor devices are initialized one by one. */
u32_t ramdev_size;
int i, s;
2005-04-21 16:53:53 +02:00
2005-04-29 17:36:43 +02:00
if (OK != (s=sys_getkinfo(&kinfo))) {
panic("MEM","Couldn't get kernel information.",s);
2005-04-21 16:53:53 +02:00
}
2005-04-22 15:25:17 +02:00
#if 0
/* Map in kernel memory for /dev/kmem. */
2005-04-29 17:36:43 +02:00
m_geom[KMEM_DEV].dv_base = cvul64(kinfo.kmem_base);
m_geom[KMEM_DEV].dv_size = cvul64(kinfo.kmem_size);
if((m_vaddrs[KMEM_DEV] = vm_map_phys(SELF, (void *) kinfo.kmem_base,
kinfo.kmem_size)) == MAP_FAILED) {
printf("MEM: Couldn't map in /dev/kmem.");
2005-04-29 17:36:43 +02:00
}
#endif
2005-04-29 17:36:43 +02:00
/* Ramdisk image built into the memory driver */
m_geom[IMGRD_DEV].dv_base= cvul64(0);
m_geom[IMGRD_DEV].dv_size= cvul64(imgrd_size);
m_vaddrs[IMGRD_DEV] = (vir_bytes) imgrd;
/* Initialize /dev/zero. Simply write zeros into the buffer. */
2005-04-29 17:36:43 +02:00
for (i=0; i<ZERO_BUF_SIZE; i++) {
dev_zero[i] = '\0';
2005-04-29 17:36:43 +02:00
}
/* Set up memory range for /dev/mem. */
m_geom[MEM_DEV].dv_base = cvul64(0);
m_geom[MEM_DEV].dv_size = cvul64(0xffffffff);
m_vaddrs[MEM_DEV] = (vir_bytes) MAP_FAILED; /* we are not mapping this in. */
2005-04-21 16:53:53 +02:00
}
/*===========================================================================*
* m_ioctl *
*===========================================================================*/
2006-06-20 10:56:15 +02:00
PRIVATE int m_ioctl(dp, m_ptr, safe)
struct driver *dp; /* pointer to driver structure */
message *m_ptr; /* pointer to control message */
2006-06-20 10:56:15 +02:00
int safe;
2005-04-21 16:53:53 +02:00
{
/* I/O controls for the memory driver. Currently there is one I/O control:
* - MIOCRAMSIZE: to set the size of the RAM disk.
*/
2005-04-21 16:53:53 +02:00
struct device *dv;
if(!safe) {
printf("m_transfer: unsafe?\n");
return EPERM;
}
2005-04-21 16:53:53 +02:00
switch (m_ptr->REQUEST) {
case MIOCRAMSIZE: {
/* Someone wants to create a new RAM disk with the given size. */
static int first_time= 1;
u32_t ramdev_size;
2005-04-21 16:53:53 +02:00
int s;
/* A ramdisk can be created only once, and only on RAM disk device. */
if (!first_time) return(EPERM);
2005-10-20 22:26:02 +02:00
if (m_ptr->DEVICE != RAM_DEV) return(EINVAL);
if ((dv = m_prepare(m_ptr->DEVICE)) == NIL_DEV) return(ENXIO);
2005-04-21 16:53:53 +02:00
/* Get request structure */
2006-06-20 10:56:15 +02:00
s= sys_safecopyfrom(m_ptr->IO_ENDPT, (vir_bytes)m_ptr->IO_GRANT,
0, (vir_bytes)&ramdev_size, sizeof(ramdev_size), D);
if (s != OK)
return s;
2006-03-13 16:41:07 +01:00
#if DEBUG
printf("allocating ramdisk of size 0x%x\n", ramdev_size);
2006-03-13 16:41:07 +01:00
#endif
2005-04-29 17:36:43 +02:00
/* Try to allocate a piece of memory for the RAM disk. */
if((m_vaddrs[RAM_DEV] = (vir_bytes) mmap(0, ramdev_size, PROT_READ|PROT_WRITE, MAP_ANON, -1, 0)) == (vir_bytes) MAP_FAILED) {
printf("MEM: failed to get memory for ramdisk\n");
return(ENOMEM);
}
2005-10-20 22:26:02 +02:00
dv->dv_size = cvul64(ramdev_size);
2007-01-22 16:37:26 +01:00
first_time= 0;
2005-04-21 16:53:53 +02:00
break;
}
default:
2006-06-20 10:56:15 +02:00
return(do_diocntl(&m_dtab, m_ptr, safe));
2005-04-21 16:53:53 +02:00
}
return(OK);
}
2005-09-11 19:09:11 +02:00
/*===========================================================================*
* m_geometry *
*===========================================================================*/
2005-04-21 16:53:53 +02:00
PRIVATE void m_geometry(entry)
struct partition *entry;
{
/* Memory devices don't have a geometry, but the outside world insists. */
entry->cylinders = div64u(m_geom[m_device].dv_size, SECTOR_SIZE) / (64 * 32);
entry->heads = 64;
entry->sectors = 32;
}