X-Git-Url: http://rtime.felk.cvut.cz/gitweb/lincan.git/blobdiff_plain/c316aed80a2047f337dc0cff35e2458c4cb13eca..ca4ad65fe791cd40f1dcec6d0398fd74b31051cd:/lincan/src/ssv.c

diff --git a/lincan/src/ssv.c b/lincan/src/ssv.c
index 83fbba3..802aee7 100644
--- a/lincan/src/ssv.c
+++ b/lincan/src/ssv.c
@@ -14,6 +14,8 @@
 int ssvcan_irq[2]={-1,-1};
 unsigned long ssvcan_base=0x0;
 
+static can_spinlock_t ssv_port_lock=SPIN_LOCK_UNLOCKED;
+
 /* IO_RANGE is the io-memory range that gets reserved, please adjust according
  * your hardware. Example: #define IO_RANGE 0x100 for i82527 chips or
  * #define IO_RANGE 0x20 for sja1000 chips.
@@ -209,21 +211,22 @@ unsigned ssv_read_register(unsigned long address)
        want to read in a first time. In a second time we read the
        data */
     unsigned char ret;
+    can_spin_irqflags_t flags;
     
 
     if((address-ssvcan_base)<0x100)
     {
-	can_disable_irq(ssvcan_irq[0]);
+	can_spin_lock_irqsave(&ssv_port_lock,flags);
 	outb(address-ssvcan_base, ssvcan_base);
 	ret=inb(ssvcan_base+1);
-	can_enable_irq(ssvcan_irq[0]);
+	can_spin_unlock_irqrestore(&ssv_port_lock,flags);
     }
     else
     {
-	can_disable_irq(ssvcan_irq[1]);
+	can_spin_lock_irqsave(&ssv_port_lock,flags);
 	outb(address-ssvcan_base-0x100, ssvcan_base+0x02);
 	ret=inb(ssvcan_base+1+0x02);
-	can_enable_irq(ssvcan_irq[1]);
+	can_spin_unlock_irqrestore(&ssv_port_lock,flags);
     }
 
     return ret;