]> rtime.felk.cvut.cz Git - lincan.git/blobdiff - lincan/src/ssv.c
Changed data size from byte to unsigned for write_register indirect call
[lincan.git] / lincan / src / ssv.c
index 83fbba3115fc19409fdfb61b21807e18b3825f30..6f1b585442b8579f8594b93714d03a3da99d3ba3 100644 (file)
@@ -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.
@@ -183,7 +185,7 @@ int ssv_program_irq(struct candevice_t *candev)
  * on the CAN chip. You should only have to edit this function if your hardware
  * uses some specific write process.
  */
-void ssv_write_register(unsigned char data, unsigned long address)
+void ssv_write_register(unsigned data, unsigned long address)
 {
     /* address is an absolute address */
 
@@ -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;