Return to char_dev.c CVS log

Up to [Early Linux] / linux / fs

linux 0.95c+

/*
 *  linux/fs/char_dev.c
 *
 *  (C) 1991  Linus Torvalds
 */

#include <errno.h>
#include <sys/types.h>

#include <linux/sched.h>
#include <linux/kernel.h>

#include <checkpoint.h>
#include <asm/segment.h>
#include <asm/io.h>

extern int tty_read(unsigned minor,char * buf,int count,unsigned short flags);
extern int tty_write(unsigned minor,char * buf,int count);
extern int lp_write(unsigned minor,char *buf, int count);

typedef (*crw_ptr)(int,unsigned,char *,int,off_t *,unsigned short);

static int rw_ttyx(int rw,unsigned minor,char * buf,int count,off_t * pos, unsigned short flags)
{
	return ((rw==READ)?tty_read(minor,buf,count,flags):
		tty_write(minor,buf,count));
}

static int rw_lp(int rw,unsigned minor,char * buf,int count,off_t * pos, unsigned short flags)
{
	return ((rw==READ)?-EINVAL:lp_write(minor,buf,count));
}

static int rw_tty(int rw,unsigned minor,char * buf,int count, off_t * pos, unsigned short flags)
{
	if (current->tty<0)
		return -EPERM;
	return rw_ttyx(rw,current->tty,buf,count,pos,flags);
}

static int rw_ram(int rw,char * buf, int count, off_t *pos)
{
	return -EIO;
}

static int rw_mem(int rw,char * buf, int count, off_t * pos)
{
	char *p;
	unsigned long pde, pte, tmp;
	int i = count;

	if (count <= 0)
		return(0);
	/*
	 * return EOF on nonexistant pages or pages swapped out to disk
	 */
	pde = (unsigned long) pg_dir + (*pos >> 20 & 0xffc);
	if (((pte = *((unsigned long *) pde)) & 1) == 0)
		return 0;	/* page table not present */
	pte &= 0xfffff000;
	pte += *pos >> 10 & 0xffc;
	if (((tmp = *((unsigned long *) pte)) & 1) == 0)
		return 0;
	if (rw == WRITE && (tmp & 2) == 0)
		un_wp_page((unsigned long *) pte);
	p = (char *) ((tmp & 0xfffff000) + (*pos & 0xfff));
	while (1) {
		if (rw == WRITE)
			*p++ = get_fs_byte(buf++);
		else
			put_fs_byte(*p++, buf++);

		if (--i == 0)
			break;

		if (count && ((unsigned long) p & 0xfff) == 0) {
			if (((pte += 4) & 0xfff) == 0) {
				if (((pde += 4) & 0xfff) == 0)
					break;
				if (((pte = *((unsigned long *) pde)) & 1) == 0)
					break;
				pte &= 0xfffff000;
			}
			if (((tmp = *((unsigned long *) pte)) & 1) == 0)
				break;

			if (rw == WRITE && (tmp & 2) == 0)
				un_wp_page((unsigned long *) pte);
			p = (char *) (tmp & 0xfffff000);
		}
	}
	return(count - i);
}

static int rw_kmem(int rw,char * buf, int count, off_t * pos)
{
	char *p=(char *) *pos;

	if ((unsigned long) *pos > HIGH_MEMORY)
		return 0;
	if ((unsigned long) *pos + count > HIGH_MEMORY)
		count = HIGH_MEMORY - *pos;

	switch (rw) {
		case READ:
			while ((count -= 4) >= 0)
				put_fs_long(*((unsigned long *) p)++, 
					    ((unsigned long *) buf)++);
			count += 4;
			while (--count >= 0)
				put_fs_byte(*p++, buf++);
			break;
		case WRITE:
			while (--count >= 0)
				*p++ = get_fs_byte(buf++);
			break;
		default:
			return -EINVAL;
	}
	p -= *pos;
	*pos += (int) p;
	return (int) p;
}

static int rw_port(int rw,char * buf, int count, off_t * pos)
{
	int i=*pos;

	while (count-->0 && i<65536) {
		if (rw==READ)
			put_fs_byte(inb(i),buf++);
		else
			outb(get_fs_byte(buf++),i);
		i++;
	}
	i -= *pos;
	*pos += i;
	return i;
}

static int rw_memory(int rw, unsigned minor, char * buf, int count,
	off_t * pos, unsigned short flags)
{
	switch(minor) {
		case 0:
			return rw_ram(rw,buf,count,pos);
		case 1:
			return rw_mem(rw,buf,count,pos);
		case 2:
			return rw_kmem(rw,buf,count,pos);
		case 3:
			return (rw==READ)?0:count;	/* rw_null */
		case 4:
			return rw_port(rw,buf,count,pos);
		default:
			return -EIO;
	}
}

#define NRDEVS ((sizeof (crw_table))/(sizeof (crw_ptr)))

static crw_ptr crw_table[]={
	NULL,		/* nodev */
	rw_memory,	/* /dev/mem etc */
	NULL,		/* /dev/fd */
	NULL,		/* /dev/hd */
	rw_ttyx,	/* /dev/ttyx */
	rw_tty,		/* /dev/tty */
	rw_lp,		/* /dev/lp */
	NULL};		/* unnamed pipes */

int char_read(struct inode * inode, struct file * filp, char * buf, int count)
{
	unsigned int major,minor;
	crw_ptr call_addr;

	major = MAJOR(inode->i_rdev);
	minor = MINOR(inode->i_rdev);
	if (major >= NRDEVS)
		return -ENODEV;
	if (!(call_addr = crw_table[major]))
		return -ENODEV;
	return call_addr(READ,minor,buf,count,&filp->f_pos,filp->f_flags);
}

int char_write(struct inode * inode, struct file * filp, char * buf, int count)
{
	unsigned int major,minor;
	crw_ptr call_addr;

	major = MAJOR(inode->i_rdev);
	minor = MINOR(inode->i_rdev);
	if (major >= NRDEVS)
		return -ENODEV;
	if (!(call_addr=crw_table[major]))
		return -ENODEV;
	return call_addr(WRITE,minor,buf,count,&filp->f_pos,filp->f_flags);
}

This archive runs on limited infrastructure. Preserving old code on modern bandwidth. Automated agents are requested to crawl responsibly.