[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / macintosh / ans-lcd.c

/*
 * /dev/lcd driver for Apple Network Servers.
 */

#include <linux/types.h>
#include <linux/errno.h>
#include <linux/kernel.h>
#include <linux/miscdevice.h>
#include <linux/fcntl.h>
#include <linux/init.h>
#include <linux/delay.h>
#include <linux/fs.h>

#include <asm/uaccess.h>
#include <asm/sections.h>
#include <asm/prom.h>
#include <asm/io.h>

#include "ans-lcd.h"

#define ANSLCD_ADDR		0xf301c000
#define ANSLCD_CTRL_IX 0x00
#define ANSLCD_DATA_IX 0x10

static unsigned long anslcd_short_delay = 80;
static unsigned long anslcd_long_delay = 3280;
static volatile unsigned char __iomem *anslcd_ptr;
static DEFINE_MUTEX(anslcd_mutex);

#undef DEBUG

static void
anslcd_write_byte_ctrl ( unsigned char c )
{
#ifdef DEBUG
	printk(KERN_DEBUG "LCD: CTRL byte: %02x\n",c);
#endif
	out_8(anslcd_ptr + ANSLCD_CTRL_IX, c);
	switch(c) {
		case 1:
		case 2:
		case 3:
			udelay(anslcd_long_delay); break;
		default: udelay(anslcd_short_delay);
	}
}

static void
anslcd_write_byte_data ( unsigned char c )
{
	out_8(anslcd_ptr + ANSLCD_DATA_IX, c);
	udelay(anslcd_short_delay);
}

static ssize_t
anslcd_write( struct file * file, const char __user * buf, 
				size_t count, loff_t *ppos )
{
	const char __user *p = buf;
	int i;

#ifdef DEBUG
	printk(KERN_DEBUG "LCD: write\n");
#endif

	if (!access_ok(VERIFY_READ, buf, count))
		return -EFAULT;

	mutex_lock(&anslcd_mutex);
	for ( i = *ppos; count > 0; ++i, ++p, --count ) 
	{
		char c;
		__get_user(c, p);
		anslcd_write_byte_data( c );
	}
	mutex_unlock(&anslcd_mutex);
	*ppos = i;
	return p - buf;
}

static long
anslcd_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
{
	char ch, __user *temp;
	long ret = 0;

#ifdef DEBUG
	printk(KERN_DEBUG "LCD: ioctl(%d,%d)\n",cmd,arg);
#endif

	mutex_lock(&anslcd_mutex);

	switch ( cmd )
	{
	case ANSLCD_CLEAR:
		anslcd_write_byte_ctrl ( 0x38 );
		anslcd_write_byte_ctrl ( 0x0f );
		anslcd_write_byte_ctrl ( 0x06 );
		anslcd_write_byte_ctrl ( 0x01 );
		anslcd_write_byte_ctrl ( 0x02 );
		break;
	case ANSLCD_SENDCTRL:
		temp = (char __user *) arg;
		__get_user(ch, temp);
		for (; ch; temp++) { /* FIXME: This is ugly, but should work, as a \0 byte is not a valid command code */
			anslcd_write_byte_ctrl ( ch );
			__get_user(ch, temp);
		}
		break;
	case ANSLCD_SETSHORTDELAY:
		if (!capable(CAP_SYS_ADMIN))
			ret =-EACCES;
		else
			anslcd_short_delay=arg;
		break;
	case ANSLCD_SETLONGDELAY:
		if (!capable(CAP_SYS_ADMIN))
			ret = -EACCES;
		else
			anslcd_long_delay=arg;
		break;
	default:
		ret = -EINVAL;
	}

	mutex_unlock(&anslcd_mutex);
	return ret;
}

static int
anslcd_open( struct inode * inode, struct file * file )
{
	return 0;
}

const struct file_operations anslcd_fops = {
	.write		= anslcd_write,
	.unlocked_ioctl	= anslcd_ioctl,
	.open		= anslcd_open,
	.llseek		= default_llseek,
};

static struct miscdevice anslcd_dev = {
	ANSLCD_MINOR,
	"anslcd",
	&anslcd_fops
};

const char anslcd_logo[] =	"********************"  /* Line #1 */
				"*      LINUX!      *"  /* Line #3 */
				"*    Welcome to    *"  /* Line #2 */
				"********************"; /* Line #4 */

static int __init
anslcd_init(void)
{
	int a;
	int retval;
	struct device_node* node;

	node = of_find_node_by_name(NULL, "lcd");
	if (!node || !node->parent || strcmp(node->parent->name, "gc")) {
		of_node_put(node);
		return -ENODEV;
	}
	of_node_put(node);

	anslcd_ptr = ioremap(ANSLCD_ADDR, 0x20);
	
	retval = misc_register(&anslcd_dev);
	if(retval < 0){
		printk(KERN_INFO "LCD: misc_register failed\n");
		iounmap(anslcd_ptr);
		return retval;
	}

#ifdef DEBUG
	printk(KERN_DEBUG "LCD: init\n");
#endif

	mutex_lock(&anslcd_mutex);
	anslcd_write_byte_ctrl ( 0x38 );
	anslcd_write_byte_ctrl ( 0x0c );
	anslcd_write_byte_ctrl ( 0x06 );
	anslcd_write_byte_ctrl ( 0x01 );
	anslcd_write_byte_ctrl ( 0x02 );
	for(a=0;a<80;a++) {
		anslcd_write_byte_data(anslcd_logo[a]);
	}
	mutex_unlock(&anslcd_mutex);
	return 0;
}

static void __exit
anslcd_exit(void)
{
	misc_deregister(&anslcd_dev);
	iounmap(anslcd_ptr);
}

module_init(anslcd_init);
module_exit(anslcd_exit);
Commit	Line	Data
1da177e4 LT	1	/*
	2	* /dev/lcd driver for Apple Network Servers.
	3	*/
	4
	5	#include <linux/types.h>
	6	#include <linux/errno.h>
	7	#include <linux/kernel.h>
	8	#include <linux/miscdevice.h>
	9	#include <linux/fcntl.h>
	10	#include <linux/init.h>
	11	#include <linux/delay.h>
	12	#include <linux/fs.h>
	13
	14	#include <asm/uaccess.h>
	15	#include <asm/sections.h>
	16	#include <asm/prom.h>
1da177e4 LT	17	#include <asm/io.h>
1da177e4 LT	18
33d71d26 KG	19	#include "ans-lcd.h"
33d71d26 KG	20
1da177e4 LT	21	#define ANSLCD_ADDR 0xf301c000
	22	#define ANSLCD_CTRL_IX 0x00
	23	#define ANSLCD_DATA_IX 0x10
	24
	25	static unsigned long anslcd_short_delay = 80;
	26	static unsigned long anslcd_long_delay = 3280;
	27	static volatile unsigned char __iomem *anslcd_ptr;
95fdac73	28	static DEFINE_MUTEX(anslcd_mutex);
1da177e4 LT	29
	30	#undef DEBUG
	31
aacaf9bd	32	static void
1da177e4 LT	33	anslcd_write_byte_ctrl ( unsigned char c )
	34	{
	35	#ifdef DEBUG
	36	printk(KERN_DEBUG "LCD: CTRL byte: %02x\n",c);
	37	#endif
	38	out_8(anslcd_ptr + ANSLCD_CTRL_IX, c);
	39	switch(c) {
	40	case 1:
	41	case 2:
	42	case 3:
	43	udelay(anslcd_long_delay); break;
	44	default: udelay(anslcd_short_delay);
	45	}
	46	}
	47
aacaf9bd	48	static void
1da177e4 LT	49	anslcd_write_byte_data ( unsigned char c )
	50	{
	51	out_8(anslcd_ptr + ANSLCD_DATA_IX, c);
	52	udelay(anslcd_short_delay);
	53	}
	54
aacaf9bd	55	static ssize_t
1da177e4 LT	56	anslcd_write( struct file * file, const char __user * buf,
	57	size_t count, loff_t *ppos )
	58	{
	59	const char __user *p = buf;
	60	int i;
	61
	62	#ifdef DEBUG
	63	printk(KERN_DEBUG "LCD: write\n");
	64	#endif
	65
	66	if (!access_ok(VERIFY_READ, buf, count))
	67	return -EFAULT;
95fdac73 TG	68
95fdac73 TG	69	mutex_lock(&anslcd_mutex);
1da177e4 LT	70	for ( i = *ppos; count > 0; ++i, ++p, --count )
	71	{
	72	char c;
	73	__get_user(c, p);
	74	anslcd_write_byte_data( c );
	75	}
95fdac73	76	mutex_unlock(&anslcd_mutex);
1da177e4 LT	77	*ppos = i;
	78	return p - buf;
	79	}
	80
95fdac73 TG	81	static long
95fdac73 TG	82	anslcd_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
1da177e4 LT	83	{
1da177e4 LT	84	char ch, __user *temp;
95fdac73	85	long ret = 0;
1da177e4 LT	86
	87	#ifdef DEBUG
	88	printk(KERN_DEBUG "LCD: ioctl(%d,%d)\n",cmd,arg);
	89	#endif
	90
95fdac73 TG	91	mutex_lock(&anslcd_mutex);
95fdac73 TG	92
1da177e4 LT	93	switch ( cmd )
	94	{
	95	case ANSLCD_CLEAR:
	96	anslcd_write_byte_ctrl ( 0x38 );
	97	anslcd_write_byte_ctrl ( 0x0f );
	98	anslcd_write_byte_ctrl ( 0x06 );
	99	anslcd_write_byte_ctrl ( 0x01 );
	100	anslcd_write_byte_ctrl ( 0x02 );
95fdac73	101	break;
1da177e4 LT	102	case ANSLCD_SENDCTRL:
	103	temp = (char __user *) arg;
	104	__get_user(ch, temp);
	105	for (; ch; temp++) { /* FIXME: This is ugly, but should work, as a \0 byte is not a valid command code */
	106	anslcd_write_byte_ctrl ( ch );
	107	__get_user(ch, temp);
	108	}
95fdac73	109	break;
1da177e4 LT	110	case ANSLCD_SETSHORTDELAY:
1da177e4 LT	111	if (!capable(CAP_SYS_ADMIN))
95fdac73 TG	112	ret =-EACCES;
	113	else
	114	anslcd_short_delay=arg;
	115	break;
1da177e4 LT	116	case ANSLCD_SETLONGDELAY:
1da177e4 LT	117	if (!capable(CAP_SYS_ADMIN))
95fdac73 TG	118	ret = -EACCES;
	119	else
	120	anslcd_long_delay=arg;
	121	break;
1da177e4	122	default:
95fdac73	123	ret = -EINVAL;
1da177e4	124	}
95fdac73 TG	125
	126	mutex_unlock(&anslcd_mutex);
	127	return ret;
1da177e4 LT	128	}
1da177e4 LT	129
aacaf9bd	130	static int
1da177e4 LT	131	anslcd_open( struct inode * inode, struct file * file )
	132	{
	133	return 0;
	134	}
	135
fa027c2a	136	const struct file_operations anslcd_fops = {
95fdac73 TG	137	.write = anslcd_write,
	138	.unlocked_ioctl = anslcd_ioctl,
	139	.open = anslcd_open,
6038f373	140	.llseek = default_llseek,
1da177e4 LT	141	};
	142
	143	static struct miscdevice anslcd_dev = {
	144	ANSLCD_MINOR,
	145	"anslcd",
	146	&anslcd_fops
	147	};
	148
	149	const char anslcd_logo[] = "*******************" / Line #1 */
	150	"* LINUX! " / Line #3 */
	151	"* Welcome to " / Line #2 */
	152	"*******************"; / Line #4 */
	153
	154	static int __init
	155	anslcd_init(void)
	156	{
	157	int a;
	158	int retval;
	159	struct device_node* node;
	160
30686ba6 SR	161	node = of_find_node_by_name(NULL, "lcd");
	162	if (!node \|\| !node->parent \|\| strcmp(node->parent->name, "gc")) {
	163	of_node_put(node);
1da177e4	164	return -ENODEV;
30686ba6 SR	165	}
30686ba6 SR	166	of_node_put(node);
1da177e4 LT	167
	168	anslcd_ptr = ioremap(ANSLCD_ADDR, 0x20);
	169
	170	retval = misc_register(&anslcd_dev);
	171	if(retval < 0){
	172	printk(KERN_INFO "LCD: misc_register failed\n");
	173	iounmap(anslcd_ptr);
	174	return retval;
	175	}
	176
	177	#ifdef DEBUG
	178	printk(KERN_DEBUG "LCD: init\n");
	179	#endif
	180
95fdac73	181	mutex_lock(&anslcd_mutex);
1da177e4 LT	182	anslcd_write_byte_ctrl ( 0x38 );
	183	anslcd_write_byte_ctrl ( 0x0c );
	184	anslcd_write_byte_ctrl ( 0x06 );
	185	anslcd_write_byte_ctrl ( 0x01 );
	186	anslcd_write_byte_ctrl ( 0x02 );
	187	for(a=0;a<80;a++) {
	188	anslcd_write_byte_data(anslcd_logo[a]);
	189	}
95fdac73	190	mutex_unlock(&anslcd_mutex);
1da177e4 LT	191	return 0;
	192	}
	193
	194	static void __exit
	195	anslcd_exit(void)
	196	{
	197	misc_deregister(&anslcd_dev);
	198	iounmap(anslcd_ptr);
	199	}
	200
	201	module_init(anslcd_init);
	202	module_exit(anslcd_exit);