forked from Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
205 lines
4.0 KiB
205 lines
4.0 KiB
// SPDX-License-Identifier: GPL-2.0 |
|
/* |
|
* /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/module.h> |
|
#include <linux/delay.h> |
|
#include <linux/fs.h> |
|
|
|
#include <linux/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(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 = { |
|
LCD_MINOR, |
|
"anslcd", |
|
&anslcd_fops |
|
}; |
|
|
|
static const char anslcd_logo[] __initconst = |
|
"********************" /* 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 || !of_node_name_eq(node->parent, "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); |
|
MODULE_LICENSE("GPL v2");
|
|
|