/*
* Simple - REALLY simple memory mapping demonstration.
*/
#include <linux/module.h>
#include <linux/moduleparam.h>
#include <linux/init.h>
#include <linux/kernel.h> /* printk() */
#include <linux/slab.h> /* kmalloc() */
#include <linux/fs.h> /* everything... */
#include <linux/errno.h> /* error codes */
#include <linux/types.h> /* size_t */
#include <linux/mm.h>
#include <linux/kdev_t.h>
#include <linux/cdev.h>
#include <linux/delay.h>
#include <linux/device.h>
#include <asm/io.h>
#include <asm/uaccess.h>
#define pGPG3CON 0xE03001C0
#define pGPG3DAT 0xE03001C4
static void *vGPG3CON , *vGPG3DAT;
#define GPG3CON (*(volatile unsigned int *) vGPG3CON)
#define GPG3DAT (*(volatile unsigned int *) vGPG3DAT)
#define LED_ON 0x4800
#define LED_OFF 0x4801
static int simple_major = 250;
module_param(simple_major, int, 0);
MODULE_AUTHOR("farsight");
MODULE_LICENSE("Dual BSD/GPL");
//static int flag = 0;
/*
* Open the device; in fact, there's nothing to do here.
*/
int simple_open (struct inode *inode, struct file *filp)
{
vGPG3CON=ioremap(pGPG3CON,0x10);
vGPG3DAT=vGPG3CON+0x04;
GPG3CON=0x1111;
GPG3DAT &= ~0xf;
printk(KERN_INFO "led device opened *****************8\n");
return 0;
}
ssize_t simple_read(struct file *file, char __user *buff, size_t count, loff_t *offp)
{
return 0;
}
ssize_t simple_write(struct file *file, const char __user *buff, size_t count, loff_t *offp)
{
return 0;
}
void led_off( void )
{
printk(KERN_INFO "led off *****************\n");
GPG3DAT=GPG3DAT|(1<<2);
//printk("stop led\n");
}
void led_on( void )
{
printk(KERN_INFO "led on ****************88\n");
GPG3DAT=GPG3DAT&(~(1<<2));
//printk("start led\n");
}
static int simple_ioctl(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg)
{
switch ( cmd )
{
case LED_ON:
{
led_on();
break;
}
case LED_OFF:
{
led_off();
break;
}
default:
{
break;
}
}
return 0;
}
static int simple_release(struct inode *node, struct file *file)
{
printk(KERN_INFO "led device release *****************8\n");
return 0;
}
/*
* Set up the cdev structure for a device.
*/
static void simple_setup_cdev(struct cdev *dev, int minor,
struct file_operations *fops)
{
int err, devno = MKDEV(simple_major, minor);
cdev_init(dev, fops);
dev->owner = THIS_MODULE;
dev->ops = fops;
err = cdev_add (dev, devno, 1);
/* Fail gracefully if need be */
if (err)
printk (KERN_NOTICE "Error %d adding simple%d", err, minor);
}
/*
* Our various sub-devices.
*/
/* Device 0 uses remap_pfn_range */
static struct file_operations simple_remap_ops = {
.owner = THIS_MODULE,
.open = simple_open,
.release = simple_release,
.read = simple_read,
.write = simple_write,
.ioctl = simple_ioctl,
};
/*
* We export two simple devices. There's no need for us to maintain any
* special housekeeping info, so we just deal with raw cdevs.
*/
static struct cdev SimpleDevs;
/*
* Module housekeeping.
*/
static struct class *my_class;
static int simple_init(void)
{
int result;
dev_t dev = MKDEV(simple_major, 0);
/* Figure out our device number. */
if (simple_major)
result = register_chrdev_region(dev, 1, "led");
else {
result = alloc_chrdev_region(&dev, 0, 1, "led");
simple_major = MAJOR(dev);
}
if (result < 0) {
printk(KERN_WARNING "simple: unable to get major %d\n", simple_major);
return result;
}
if (simple_major == 0)
simple_major = result;
/* Now set up two cdevs. */
simple_setup_cdev(&SimpleDevs, 0, &simple_remap_ops);
printk("simple device installed, with major %d\n", simple_major);
my_class= class_create(THIS_MODULE, "led");
device_create(my_class, NULL, MKDEV(simple_major, 0),
NULL, "led");
return 0;
}
static void simple_cleanup(void)
{
cdev_del(&SimpleDevs);
unregister_chrdev_region(MKDEV(simple_major, 0), 1);
device_destroy(my_class,MKDEV(simple_major,0));
class_destroy(my_class);
printk("simple device uninstalled\n");
}
module_init(simple_init);
module_exit(simple_cleanup);
/*
* main.c : test demo driver
*/
#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <fcntl.h>
#include <string.h>
#include <sys/types.h>
#include <sys/stat.h>
#define LED_ON 0x4800
#define LED_OFF 0x4801
int main()
{
int i = 0;
int dev_fd;
dev_fd = open("/dev/led",O_RDWR | O_NONBLOCK);
if ( dev_fd == -1 ) {
printf("Cann't open file /dev/led\n");
exit(1);
}
while(1)
{
ioctl(dev_fd,LED_ON,0);
printf("LED ON ___________________\n");
sleep(1);
ioctl(dev_fd,LED_OFF,0);
printf("LED OFF ___________-\n");
sleep(1);
}
return 0;
}
ifeq ($(KERNELRELEASE),)
KERNELDIR ?= /source/android-2.6.29-samsung
PWD := $(shell pwd)
modules:
$(MAKE) -C $(KERNELDIR) M=$(PWD) modules
modules_install:
$(MAKE) -C $(KERNELDIR) M=$(PWD) modules_install
clean:
rm -rf *.o *~ core .depend .*.cmd *.ko *.mod.c .tmp_versions
.PHONY: modules modules_install clean
else
obj-m := led_drv.o
endif