1 files changed, 66 insertions, 85 deletions

diff --git a/drivers/usb/misc/sisusbvga/sisusb_con.c b/drivers/usb/misc/sisusbvga/sisusb_con.c
index be5c1a25ae2..fb48feca835 100644
--- a/drivers/usb/misc/sisusbvga/sisusb_con.c
+++ b/drivers/usb/misc/sisusbvga/sisusb_con.c
@@ -48,6 +48,7 @@
  */
 
 #include <linux/config.h>
+#include <linux/mutex.h>
 #include <linux/module.h>
 #include <linux/kernel.h>
 #include <linux/signal.h>
@@ -69,27 +70,9 @@
 #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))
@@ -102,8 +85,6 @@ static struct sisusb_usb_data *mysisusbs[MAX_NR_CONSOLES];
 /* 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)
 {
@@ -194,11 +175,11 @@ sisusb_get_sisusb_lock_and_check(unsigned short console)
         if (!(sisusb = sisusb_get_sisusb(console)))
                 return NULL;
 
-        down(&sisusb->lock);
+        mutex_lock(&sisusb->lock);
 
         if (!sisusb_sisusb_valid(sisusb) ||
             !sisusb->havethisconsole[console]) {
-                up(&sisusb->lock);
+                mutex_unlock(&sisusb->lock);
                 return NULL;
         }
 
@@ -236,18 +217,18 @@ sisusbcon_init(struct vc_data *c, int init)
          * are set up/restored.
          */
 
-        down(&disconnect_sem);
+        mutex_lock(&disconnect_mutex);
 
         if (!(sisusb = sisusb_get_sisusb(c->vc_num))) {
-                up(&disconnect_sem);
+                mutex_unlock(&disconnect_mutex);
                 return;
         }
 
-        down(&sisusb->lock);
+        mutex_lock(&sisusb->lock);
 
         if (!sisusb_sisusb_valid(sisusb)) {
-                up(&sisusb->lock);
-                up(&disconnect_sem);
+                mutex_unlock(&sisusb->lock);
+                mutex_unlock(&disconnect_mutex);
                 return;
         }
 
@@ -284,9 +265,9 @@ sisusbcon_init(struct vc_data *c, int init)
         if (!*c->vc_uni_pagedir_loc)
                 con_set_default_unimap(c);
 
-        up(&sisusb->lock);
+        mutex_unlock(&sisusb->lock);
 
-        up(&disconnect_sem);
+        mutex_unlock(&disconnect_mutex);
 
         if (init) {
                 c->vc_cols = cols;
@@ -306,14 +287,14 @@ sisusbcon_deinit(struct vc_data *c)
          * and others, ie not under our control.
          */
 
-        down(&disconnect_sem);
+        mutex_lock(&disconnect_mutex);
 
         if (!(sisusb = sisusb_get_sisusb(c->vc_num))) {
-                up(&disconnect_sem);
+                mutex_unlock(&disconnect_mutex);
                 return;
         }
 
-        down(&sisusb->lock);
+        mutex_lock(&sisusb->lock);
 
         /* Clear ourselves in mysisusbs */
         mysisusbs[c->vc_num] = NULL;
@@ -332,12 +313,12 @@ sisusbcon_deinit(struct vc_data *c)
                 }
         }
 
-        up(&sisusb->lock);
+        mutex_unlock(&sisusb->lock);
 
         /* decrement the usage count on our sisusb */
         kref_put(&sisusb->kref, sisusb_delete);
 
-        up(&disconnect_sem);
+        mutex_unlock(&disconnect_mutex);
 }
 
 /* interface routine */
@@ -417,7 +398,7 @@ sisusbcon_putc(struct vc_data *c, int ch, int y, int x)
 #endif
 
         if (sisusb_is_inactive(c, sisusb)) {
-                up(&sisusb->lock);
+                mutex_unlock(&sisusb->lock);
                 return;
         }
 
@@ -425,7 +406,7 @@ sisusbcon_putc(struct vc_data *c, int ch, int y, int x)
         sisusb_copy_memory(sisusb, (char *)SISUSB_VADDR(x, y),
                                 (u32)SISUSB_HADDR(x, y), 2, &written);
 
-        up(&sisusb->lock);
+        mutex_unlock(&sisusb->lock);
 }
 
 /* Interface routine */
@@ -453,14 +434,14 @@ sisusbcon_putcs(struct vc_data *c, const unsigned short *s,
                 sisusbcon_writew(sisusbcon_readw(s++), dest++);
 
         if (sisusb_is_inactive(c, sisusb)) {
-                up(&sisusb->lock);
+                mutex_unlock(&sisusb->lock);
                 return;
         }
 
         sisusb_copy_memory(sisusb, (char *)SISUSB_VADDR(x, y),
                                 (u32)SISUSB_HADDR(x, y), count * 2, &written);
 
-        up(&sisusb->lock);
+        mutex_unlock(&sisusb->lock);
 }
 
 /* Interface routine */
@@ -504,7 +485,7 @@ sisusbcon_clear(struct vc_data *c, int y, int x, int height, int width)
         }
 
         if (sisusb_is_inactive(c, sisusb)) {
-                up(&sisusb->lock);
+                mutex_unlock(&sisusb->lock);
                 return;
         }
 
@@ -514,7 +495,7 @@ sisusbcon_clear(struct vc_data *c, int y, int x, int height, int width)
         sisusb_copy_memory(sisusb, (unsigned char *)SISUSB_VADDR(x, y),
                                 (u32)SISUSB_HADDR(x, y), length, &written);
 
-        up(&sisusb->lock);
+        mutex_unlock(&sisusb->lock);
 }
 
 /* Interface routine */
@@ -576,7 +557,7 @@ sisusbcon_bmove(struct vc_data *c, int sy, int sx,
 #endif
 
         if (sisusb_is_inactive(c, sisusb)) {
-                up(&sisusb->lock);
+                mutex_unlock(&sisusb->lock);
                 return;
         }
 
@@ -586,7 +567,7 @@ sisusbcon_bmove(struct vc_data *c, int sy, int sx,
         sisusb_copy_memory(sisusb, (unsigned char *)SISUSB_VADDR(dx, dy),
                                 (u32)SISUSB_HADDR(dx, dy), length, &written);
 
-        up(&sisusb->lock);
+        mutex_unlock(&sisusb->lock);
 }
 
 /* interface routine */
@@ -609,7 +590,7 @@ sisusbcon_switch(struct vc_data *c)
 
         /* Don't write to screen if in gfx mode */
         if (sisusb_is_inactive(c, sisusb)) {
-                up(&sisusb->lock);
+                mutex_unlock(&sisusb->lock);
                 return 0;
         }
 
@@ -618,7 +599,7 @@ sisusbcon_switch(struct vc_data *c)
          * as origin.
          */
         if (c->vc_origin == (unsigned long)c->vc_screenbuf) {
-                up(&sisusb->lock);
+                mutex_unlock(&sisusb->lock);
                 printk(KERN_DEBUG "sisusb: ASSERT ORIGIN != SCREENBUF!\n");
                 return 0;
         }
@@ -635,7 +616,7 @@ sisusbcon_switch(struct vc_data *c)
                                 (u32)SISUSB_HADDR(0, 0),
                                 length, &written);
 
-        up(&sisusb->lock);
+        mutex_unlock(&sisusb->lock);
 
         return 0;
 }
@@ -657,7 +638,7 @@ sisusbcon_save_screen(struct vc_data *c)
         /* sisusb->lock is down */
 
         if (sisusb_is_inactive(c, sisusb)) {
-                up(&sisusb->lock);
+                mutex_unlock(&sisusb->lock);
                 return;
         }
 
@@ -669,7 +650,7 @@ sisusbcon_save_screen(struct vc_data *c)
         sisusbcon_memcpyw((u16 *)c->vc_screenbuf, (u16 *)c->vc_origin,
                                                                 length);
 
-        up(&sisusb->lock);
+        mutex_unlock(&sisusb->lock);
 }
 
 /* interface routine */
@@ -690,7 +671,7 @@ sisusbcon_set_palette(struct vc_data *c, unsigned char *table)
         /* sisusb->lock is down */
 
         if (sisusb_is_inactive(c, sisusb)) {
-                up(&sisusb->lock);
+                mutex_unlock(&sisusb->lock);
                 return -EINVAL;
         }
 
@@ -705,7 +686,7 @@ sisusbcon_set_palette(struct vc_data *c, unsigned char *table)
                         break;
         }
 
-        up(&sisusb->lock);
+        mutex_unlock(&sisusb->lock);
 
         return 0;
 }
@@ -728,7 +709,7 @@ sisusbcon_blank(struct vc_data *c, int blank, int mode_switch)
                 sisusb->is_gfx = blank ? 1 : 0;
 
         if (sisusb_is_inactive(c, sisusb)) {
-                up(&sisusb->lock);
+                mutex_unlock(&sisusb->lock);
                 return 0;
         }
 
@@ -777,7 +758,7 @@ sisusbcon_blank(struct vc_data *c, int blank, int mode_switch)
                         cr63  = 0x40;
                         break;
                 default:
-                        up(&sisusb->lock);
+                        mutex_unlock(&sisusb->lock);
                         return -EINVAL;
                 }
 
@@ -788,7 +769,7 @@ sisusbcon_blank(struct vc_data *c, int blank, int mode_switch)
 
         }
 
-        up(&sisusb->lock);
+        mutex_unlock(&sisusb->lock);
 
         return ret;
 }
@@ -809,7 +790,7 @@ sisusbcon_scrolldelta(struct vc_data *c, int lines)
         /* sisusb->lock is down */
 
         if (sisusb_is_inactive(c, sisusb)) {
-                up(&sisusb->lock);
+                mutex_unlock(&sisusb->lock);
                 return 0;
         }
 
@@ -849,7 +830,7 @@ sisusbcon_scrolldelta(struct vc_data *c, int lines)
 
         sisusbcon_set_start_address(sisusb, c);
 
-        up(&sisusb->lock);
+        mutex_unlock(&sisusb->lock);
 
         return 1;
 }
@@ -867,7 +848,7 @@ sisusbcon_cursor(struct vc_data *c, int mode)
         /* sisusb->lock is down */
 
         if (sisusb_is_inactive(c, sisusb)) {
-                up(&sisusb->lock);
+                mutex_unlock(&sisusb->lock);
                 return;
         }
 
@@ -879,7 +860,7 @@ sisusbcon_cursor(struct vc_data *c, int mode)
         if (mode == CM_ERASE) {
                 sisusb_setidxregor(sisusb, SISCR, 0x0a, 0x20);
                 sisusb->sisusb_cursor_size_to = -1;
-                up(&sisusb->lock);
+                mutex_unlock(&sisusb->lock);
                 return;
         }
 
@@ -919,7 +900,7 @@ sisusbcon_cursor(struct vc_data *c, int mode)
                 sisusb->sisusb_cursor_size_to   = to;
         }
 
-        up(&sisusb->lock);
+        mutex_unlock(&sisusb->lock);
 }
 
 static int
@@ -961,7 +942,7 @@ sisusbcon_scroll_area(struct vc_data *c, struct sisusb_usb_data *sisusb,
         sisusb_copy_memory(sisusb, (char *)SISUSB_VADDR(0, t),
                                 (u32)SISUSB_HADDR(0, t), length, &written);
 
-        up(&sisusb->lock);
+        mutex_unlock(&sisusb->lock);
 
         return 1;
 }
@@ -994,7 +975,7 @@ sisusbcon_scroll(struct vc_data *c, int t, int b, int dir, int lines)
         /* sisusb->lock is down */
 
         if (sisusb_is_inactive(c, sisusb)) {
-                up(&sisusb->lock);
+                mutex_unlock(&sisusb->lock);
                 return 0;
         }
 
@@ -1084,7 +1065,7 @@ sisusbcon_scroll(struct vc_data *c, int t, int b, int dir, int lines)
 
         c->vc_pos = c->vc_pos - oldorigin + c->vc_origin;
 
-        up(&sisusb->lock);
+        mutex_unlock(&sisusb->lock);
 
         return 1;
 }
@@ -1106,7 +1087,7 @@ sisusbcon_set_origin(struct vc_data *c)
         /* sisusb->lock is down */
 
         if (sisusb_is_inactive(c, sisusb) || sisusb->con_blanked) {
-                up(&sisusb->lock);
+                mutex_unlock(&sisusb->lock);
                 return 0;
         }
 
@@ -1116,7 +1097,7 @@ sisusbcon_set_origin(struct vc_data *c)
 
         sisusb->con_rolled_over = 0;
 
-        up(&sisusb->lock);
+        mutex_unlock(&sisusb->lock);
 
         return 1;
 }
@@ -1133,7 +1114,7 @@ sisusbcon_resize(struct vc_data *c, unsigned int newcols, unsigned int newrows)
 
         fh = sisusb->current_font_height;
 
-        up(&sisusb->lock);
+        mutex_unlock(&sisusb->lock);
 
         /* We are quite unflexible as regards resizing. The vt code
          * handles sizes where the line length isn't equal the pitch
@@ -1167,7 +1148,7 @@ sisusbcon_do_font_op(struct sisusb_usb_data *sisusb, int set, int slot,
 
         if ((slot != 0 && slot != 2) || !fh) {
                 if (uplock)
-                        up(&sisusb->lock);
+                        mutex_unlock(&sisusb->lock);
                 return -EINVAL;
         }
 
@@ -1327,7 +1308,7 @@ sisusbcon_do_font_op(struct sisusb_usb_data *sisusb, int set, int slot,
         }
 
         if (uplock)
-                up(&sisusb->lock);
+                mutex_unlock(&sisusb->lock);
 
         if (dorecalc && c) {
                 int i, rows = c->vc_scan_lines / fh;
@@ -1351,7 +1332,7 @@ sisusbcon_do_font_op(struct sisusb_usb_data *sisusb, int set, int slot,
 
 font_op_error:
         if (uplock)
-                up(&sisusb->lock);
+                mutex_unlock(&sisusb->lock);
 
         return -EIO;
 }
@@ -1417,19 +1398,19 @@ sisusbcon_font_get(struct vc_data *c, struct console_font *font)
         font->charcount = 256;
 
         if (!font->data) {
-                up(&sisusb->lock);
+                mutex_unlock(&sisusb->lock);
                 return 0;
         }
 
         if (!sisusb->font_backup) {
-                up(&sisusb->lock);
+                mutex_unlock(&sisusb->lock);
                 return -ENODEV;
         }
 
         /* Copy 256 chars only, like vgacon */
         memcpy(font->data, sisusb->font_backup, 256 * 32);
 
-        up(&sisusb->lock);
+        mutex_unlock(&sisusb->lock);
 
         return 0;
 }
@@ -1486,7 +1467,7 @@ static int sisusbdummycon_dummy(void)
 
 #define SISUSBCONDUMMY  (void *)sisusbdummycon_dummy
 
-const struct consw sisusb_dummy_con = {
+static const struct consw sisusb_dummy_con = {
         .owner =                THIS_MODULE,
         .con_startup =          sisusbdummycon_startup,
         .con_init =             sisusbdummycon_init,
@@ -1512,14 +1493,14 @@ sisusb_console_init(struct sisusb_usb_data *sisusb, int first, int last)
 {
         int i, ret, minor = sisusb->minor;
 
-        down(&disconnect_sem);
+        mutex_lock(&disconnect_mutex);
 
-        down(&sisusb->lock);
+        mutex_lock(&sisusb->lock);
 
         /* Erm.. that should not happen */
         if (sisusb->haveconsole || !sisusb->SiS_Pr) {
-                up(&sisusb->lock);
-                up(&disconnect_sem);
+                mutex_unlock(&sisusb->lock);
+                mutex_unlock(&disconnect_mutex);
                 return 1;
         }
 
@@ -1529,15 +1510,15 @@ sisusb_console_init(struct sisusb_usb_data *sisusb, int first, int last)
         if (first > last ||
             first > MAX_NR_CONSOLES ||
             last > MAX_NR_CONSOLES) {
-                up(&sisusb->lock);
-                up(&disconnect_sem);
+                mutex_unlock(&sisusb->lock);
+                mutex_unlock(&disconnect_mutex);
                 return 1;
         }
 
         /* If gfxcore not initialized or no consoles given, quit graciously */
         if (!sisusb->gfxinit || first < 1 || last < 1) {
-                up(&sisusb->lock);
-                up(&disconnect_sem);
+                mutex_unlock(&sisusb->lock);
+                mutex_unlock(&disconnect_mutex);
                 return 0;
         }
 
@@ -1547,8 +1528,8 @@ sisusb_console_init(struct sisusb_usb_data *sisusb, int first, int last)
 
         /* Set up text mode (and upload  default font) */
         if (sisusb_reset_text_mode(sisusb, 1)) {
-                up(&sisusb->lock);
-                up(&disconnect_sem);
+                mutex_unlock(&sisusb->lock);
+                mutex_unlock(&disconnect_mutex);
                 printk(KERN_ERR
                         "sisusbvga[%d]: Failed to set up text mode\n",
                         minor);
@@ -1571,16 +1552,16 @@ sisusb_console_init(struct sisusb_usb_data *sisusb, int first, int last)
 
         /* Allocate screen buffer */
         if (!(sisusb->scrbuf = (unsigned long)vmalloc(sisusb->scrbuf_size))) {
-                up(&sisusb->lock);
-                up(&disconnect_sem);
+                mutex_unlock(&sisusb->lock);
+                mutex_unlock(&disconnect_mutex);
                 printk(KERN_ERR
                         "sisusbvga[%d]: Failed to allocate screen buffer\n",
                         minor);
                 return 1;
         }
 
-        up(&sisusb->lock);
-        up(&disconnect_sem);
+        mutex_unlock(&sisusb->lock);
+        mutex_unlock(&disconnect_mutex);
 
         /* Now grab the desired console(s) */
         ret = take_over_console(&sisusb_con, first - 1, last - 1, 0);