*
*/
-#include <linux/mutex.h>
+#include <linux/config.h>
#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/signal.h>
#include <linux/vmalloc.h>
#include "sisusb.h"
-#include "sisusb_init.h"
#ifdef INCL_SISUSB_CON
+extern int sisusb_setreg(struct sisusb_usb_data *, int, u8);
+extern int sisusb_getreg(struct sisusb_usb_data *, int, u8 *);
+extern int sisusb_setidxreg(struct sisusb_usb_data *, int, u8, u8);
+extern int sisusb_getidxreg(struct sisusb_usb_data *, int, u8, u8 *);
+extern int sisusb_setidxregor(struct sisusb_usb_data *, int, u8, u8);
+extern int sisusb_setidxregand(struct sisusb_usb_data *, int, u8, u8);
+extern int sisusb_setidxregandor(struct sisusb_usb_data *, int, u8, u8, u8);
+
+extern int sisusb_writeb(struct sisusb_usb_data *sisusb, u32 adr, u8 data);
+extern int sisusb_readb(struct sisusb_usb_data *sisusb, u32 adr, u8 *data);
+extern int sisusb_writew(struct sisusb_usb_data *sisusb, u32 adr, u16 data);
+extern int sisusb_readw(struct sisusb_usb_data *sisusb, u32 adr, u16 *data);
+extern int sisusb_copy_memory(struct sisusb_usb_data *sisusb, char *src,
+ u32 dest, int length, size_t *bytes_written);
+
+extern void sisusb_delete(struct kref *kref);
+extern int sisusb_reset_text_mode(struct sisusb_usb_data *sisusb, int init);
+
+extern int SiSUSBSetMode(struct SiS_Private *SiS_Pr, unsigned short ModeNo);
#define sisusbcon_writew(val, addr) (*(addr) = (val))
#define sisusbcon_readw(addr) (*(addr))
/* Forward declaration */
static const struct consw sisusb_con;
+extern struct semaphore disconnect_sem;
+
static inline void
sisusbcon_memsetw(u16 *s, u16 c, unsigned int count)
{
if (!(sisusb = sisusb_get_sisusb(console)))
return NULL;
- mutex_lock(&sisusb->lock);
+ down(&sisusb->lock);
if (!sisusb_sisusb_valid(sisusb) ||
!sisusb->havethisconsole[console]) {
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
return NULL;
}
* are set up/restored.
*/
- mutex_lock(&disconnect_mutex);
+ down(&disconnect_sem);
if (!(sisusb = sisusb_get_sisusb(c->vc_num))) {
- mutex_unlock(&disconnect_mutex);
+ up(&disconnect_sem);
return;
}
- mutex_lock(&sisusb->lock);
+ down(&sisusb->lock);
if (!sisusb_sisusb_valid(sisusb)) {
- mutex_unlock(&sisusb->lock);
- mutex_unlock(&disconnect_mutex);
+ up(&sisusb->lock);
+ up(&disconnect_sem);
return;
}
if (!*c->vc_uni_pagedir_loc)
con_set_default_unimap(c);
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
- mutex_unlock(&disconnect_mutex);
+ up(&disconnect_sem);
if (init) {
c->vc_cols = cols;
* and others, ie not under our control.
*/
- mutex_lock(&disconnect_mutex);
+ down(&disconnect_sem);
if (!(sisusb = sisusb_get_sisusb(c->vc_num))) {
- mutex_unlock(&disconnect_mutex);
+ up(&disconnect_sem);
return;
}
- mutex_lock(&sisusb->lock);
+ down(&sisusb->lock);
/* Clear ourselves in mysisusbs */
mysisusbs[c->vc_num] = NULL;
}
}
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
/* decrement the usage count on our sisusb */
kref_put(&sisusb->kref, sisusb_delete);
- mutex_unlock(&disconnect_mutex);
+ up(&disconnect_sem);
}
/* interface routine */
#endif
if (sisusb_is_inactive(c, sisusb)) {
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
return;
}
sisusb_copy_memory(sisusb, (char *)SISUSB_VADDR(x, y),
(u32)SISUSB_HADDR(x, y), 2, &written);
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
}
/* Interface routine */
sisusbcon_writew(sisusbcon_readw(s++), dest++);
if (sisusb_is_inactive(c, sisusb)) {
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
return;
}
sisusb_copy_memory(sisusb, (char *)SISUSB_VADDR(x, y),
(u32)SISUSB_HADDR(x, y), count * 2, &written);
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
}
/* Interface routine */
}
if (sisusb_is_inactive(c, sisusb)) {
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
return;
}
sisusb_copy_memory(sisusb, (unsigned char *)SISUSB_VADDR(x, y),
(u32)SISUSB_HADDR(x, y), length, &written);
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
}
/* Interface routine */
#endif
if (sisusb_is_inactive(c, sisusb)) {
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
return;
}
sisusb_copy_memory(sisusb, (unsigned char *)SISUSB_VADDR(dx, dy),
(u32)SISUSB_HADDR(dx, dy), length, &written);
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
}
/* interface routine */
/* Don't write to screen if in gfx mode */
if (sisusb_is_inactive(c, sisusb)) {
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
return 0;
}
* as origin.
*/
if (c->vc_origin == (unsigned long)c->vc_screenbuf) {
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
printk(KERN_DEBUG "sisusb: ASSERT ORIGIN != SCREENBUF!\n");
return 0;
}
(u32)SISUSB_HADDR(0, 0),
length, &written);
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
return 0;
}
/* sisusb->lock is down */
if (sisusb_is_inactive(c, sisusb)) {
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
return;
}
sisusbcon_memcpyw((u16 *)c->vc_screenbuf, (u16 *)c->vc_origin,
length);
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
}
/* interface routine */
/* sisusb->lock is down */
if (sisusb_is_inactive(c, sisusb)) {
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
return -EINVAL;
}
break;
}
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
return 0;
}
sisusb->is_gfx = blank ? 1 : 0;
if (sisusb_is_inactive(c, sisusb)) {
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
return 0;
}
cr63 = 0x40;
break;
default:
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
return -EINVAL;
}
}
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
return ret;
}
/* sisusb->lock is down */
if (sisusb_is_inactive(c, sisusb)) {
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
return 0;
}
sisusbcon_set_start_address(sisusb, c);
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
return 1;
}
/* sisusb->lock is down */
if (sisusb_is_inactive(c, sisusb)) {
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
return;
}
if (mode == CM_ERASE) {
sisusb_setidxregor(sisusb, SISCR, 0x0a, 0x20);
sisusb->sisusb_cursor_size_to = -1;
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
return;
}
sisusb->sisusb_cursor_size_to = to;
}
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
}
static int
sisusb_copy_memory(sisusb, (char *)SISUSB_VADDR(0, t),
(u32)SISUSB_HADDR(0, t), length, &written);
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
return 1;
}
/* sisusb->lock is down */
if (sisusb_is_inactive(c, sisusb)) {
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
return 0;
}
c->vc_pos = c->vc_pos - oldorigin + c->vc_origin;
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
return 1;
}
/* sisusb->lock is down */
if (sisusb_is_inactive(c, sisusb) || sisusb->con_blanked) {
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
return 0;
}
sisusb->con_rolled_over = 0;
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
return 1;
}
fh = sisusb->current_font_height;
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
/* We are quite unflexible as regards resizing. The vt code
* handles sizes where the line length isn't equal the pitch
if ((slot != 0 && slot != 2) || !fh) {
if (uplock)
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
return -EINVAL;
}
}
if (uplock)
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
if (dorecalc && c) {
int i, rows = c->vc_scan_lines / fh;
font_op_error:
if (uplock)
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
return -EIO;
}
font->charcount = 256;
if (!font->data) {
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
return 0;
}
if (!sisusb->font_backup) {
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
return -ENODEV;
}
/* Copy 256 chars only, like vgacon */
memcpy(font->data, sisusb->font_backup, 256 * 32);
- mutex_unlock(&sisusb->lock);
+ up(&sisusb->lock);
return 0;
}
#define SISUSBCONDUMMY (void *)sisusbdummycon_dummy
-static const struct consw sisusb_dummy_con = {
+const struct consw sisusb_dummy_con = {
.owner = THIS_MODULE,
.con_startup = sisusbdummycon_startup,
.con_init = sisusbdummycon_init,
{
int i, ret, minor = sisusb->minor;
- mutex_lock(&disconnect_mutex);
+ down(&disconnect_sem);
- mutex_lock(&sisusb->lock);
+ down(&sisusb->lock);
/* Erm.. that should not happen */
if (sisusb->haveconsole || !sisusb->SiS_Pr) {
- mutex_unlock(&sisusb->lock);
- mutex_unlock(&disconnect_mutex);
+ up(&sisusb->lock);
+ up(&disconnect_sem);
return 1;
}
if (first > last ||
first > MAX_NR_CONSOLES ||
last > MAX_NR_CONSOLES) {
- mutex_unlock(&sisusb->lock);
- mutex_unlock(&disconnect_mutex);
+ up(&sisusb->lock);
+ up(&disconnect_sem);
return 1;
}
/* If gfxcore not initialized or no consoles given, quit graciously */
if (!sisusb->gfxinit || first < 1 || last < 1) {
- mutex_unlock(&sisusb->lock);
- mutex_unlock(&disconnect_mutex);
+ up(&sisusb->lock);
+ up(&disconnect_sem);
return 0;
}
/* Set up text mode (and upload default font) */
if (sisusb_reset_text_mode(sisusb, 1)) {
- mutex_unlock(&sisusb->lock);
- mutex_unlock(&disconnect_mutex);
+ up(&sisusb->lock);
+ up(&disconnect_sem);
printk(KERN_ERR
"sisusbvga[%d]: Failed to set up text mode\n",
minor);
/* Allocate screen buffer */
if (!(sisusb->scrbuf = (unsigned long)vmalloc(sisusb->scrbuf_size))) {
- mutex_unlock(&sisusb->lock);
- mutex_unlock(&disconnect_mutex);
+ up(&sisusb->lock);
+ up(&disconnect_sem);
printk(KERN_ERR
"sisusbvga[%d]: Failed to allocate screen buffer\n",
minor);
return 1;
}
- mutex_unlock(&sisusb->lock);
- mutex_unlock(&disconnect_mutex);
+ up(&sisusb->lock);
+ up(&disconnect_sem);
/* Now grab the desired console(s) */
ret = take_over_console(&sisusb_con, first - 1, last - 1, 0);
git://git.onelab.eu / linux-2.6.git / blobdiff