dsp_ctl_core.c

来自「Linux Kernel 2.6.9 for OMAP1710」· C语言 代码 · 共 110 行

/*
 * linux/arch/arm/mach-omap/dsp/dsp_ctl_core.c
 *
 * OMAP DSP control devices core driver
 *
 * Copyright (C) 2004 Nokia Corporation
 *
 * Written by Toshihiro Kobayashi <[e-mail]>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
 *
 * $Id: dsp_ctl_core.c
 * $Revision: 3.0.1
 * $Date: 2004/10/04
 *
 */

#include <linux/module.h>
#include <linux/major.h>
#include <linux/fs.h>
#include <linux/devfs_fs_kernel.h>
#include <linux/init.h>
#include <asm/arch/dsp.h>
#include "hardware_dsp.h"

#define CTL_MINOR	0
#define MEM_MINOR	1
#define TWCH_MINOR	2
#define ERR_MINOR	3

extern struct file_operations omap_dsp_ctl_fops,
			      omap_dsp_mem_fops,
			      omap_dsp_twch_fops,
			      omap_dsp_err_fops;

static int omap_dsp_ctl_core_open(struct inode *inode, struct file *file)
{
	switch (iminor(inode)) {
	case CTL_MINOR:
		file->f_op = &omap_dsp_ctl_fops;
		break;
	case MEM_MINOR:
		file->f_op = &omap_dsp_mem_fops;
		break;
	case TWCH_MINOR:
		file->f_op = &omap_dsp_twch_fops;
		break;
	case ERR_MINOR:
		file->f_op = &omap_dsp_err_fops;
		break;
	default:
		return -ENXIO;
	}
	if (file->f_op && file->f_op->open)
		return file->f_op->open(inode, file);
	return 0;
}

static struct file_operations omap_dsp_ctl_core_fops = {
	.owner = THIS_MODULE,
	.open  = omap_dsp_ctl_core_open,
};

int __init dsp_ctl_core_init(void)
{
	int retval;

	retval = register_chrdev(OMAP_DSP_CTL_MAJOR, "dspctl",
				 &omap_dsp_ctl_core_fops);
	if (retval < 0) {
		printk(KERN_ERR
		       "omapdsp: failed to register "
		       "dspctl device: %d\n", retval);
		return retval;
	}
	devfs_mk_dir("dspctl");
	devfs_mk_cdev(MKDEV(OMAP_DSP_CTL_MAJOR, CTL_MINOR),
		      S_IFCHR | S_IRUSR | S_IWUSR, "dspctl/ctl");
	devfs_mk_cdev(MKDEV(OMAP_DSP_CTL_MAJOR, MEM_MINOR),
		      S_IFCHR | S_IRUSR | S_IWUSR | S_IRGRP, "dspctl/mem");
	devfs_mk_cdev(MKDEV(OMAP_DSP_CTL_MAJOR, TWCH_MINOR),
		      S_IFCHR | S_IRUSR | S_IWUSR | S_IRGRP, "dspctl/twch");
	devfs_mk_cdev(MKDEV(OMAP_DSP_CTL_MAJOR, ERR_MINOR),
		      S_IFCHR | S_IRUSR | S_IRGRP, "dspctl/err");

	return 0;
}

void dsp_ctl_core_exit(void)
{
	devfs_remove("dspctl/err");
	devfs_remove("dspctl/twch");
	devfs_remove("dspctl/mem");
	devfs_remove("dspctl/ctl");
	devfs_remove("dspctl");
	unregister_chrdev(OMAP_DSP_CTL_MAJOR, "dspctl");
}