drivers/isdn/sc/shmem.c

   1 /* $Id: shmem.c,v 1.2.10.1 2001/09/23 22:24:59 kai Exp $
   2  *
   3  * Copyright (C) 1996  SpellCaster Telecommunications Inc.
   4  *
   5  * Card functions implementing ISDN4Linux functionality
   6  *
   7  * This software may be used and distributed according to the terms
   8  * of the GNU General Public License, incorporated herein by reference.
   9  *
  10  * For more information, please contact gpl-info@spellcast.com or write:
  11  *
  12  *     SpellCaster Telecommunications Inc.
  13  *     5621 Finch Avenue East, Unit #3
  14  *     Scarborough, Ontario  Canada
  15  *     M1B 2T9
  16  *     +1 (416) 297-8565
  17  *     +1 (416) 297-6433 Facsimile
  18  */
  19
  20 #include "includes.h"           /* This must be first */
  21 #include "hardware.h"
  22 #include "card.h"
  23
  24 /*
  25  * Main adapter array
  26  */
  27 extern board *sc_adapter[];
  28 extern int cinst;
  29
  30 /*
  31  *
  32  */
  33 void *memcpy_toshmem(int card, void *dest, const void *src, size_t n)
  34 {
  35         unsigned long flags;
  36         void *ret;
  37         unsigned char ch;
  38
  39         if(!IS_VALID_CARD(card)) {
  40                 pr_debug("Invalid param: %d is not a valid card id\n", card);
  41                 return NULL;
  42         }
  43
  44         if(n > SRAM_PAGESIZE) {
  45                 return NULL;
  46         }
  47
  48         /*
  49          * determine the page to load from the address
  50          */
  51         ch = (unsigned long) dest / SRAM_PAGESIZE;
  52         pr_debug("%s: loaded page %d\n", sc_adapter[card]->devicename,ch);
  53         /*
  54          * Block interrupts and load the page
  55          */
  56         spin_lock_irqsave(&sc_adapter[card]->lock, flags);
  57
  58         outb(((sc_adapter[card]->shmem_magic + ch * SRAM_PAGESIZE) >> 14) | 0x80,
  59                 sc_adapter[card]->ioport[sc_adapter[card]->shmem_pgport]);
  60         ret = memcpy_toio(sc_adapter[card]->rambase +
  61                 ((unsigned long) dest % 0x4000), src, n);
  62         spin_unlock_irqrestore(&sc_adapter[card]->lock, flags);
  63         pr_debug("%s: set page to %#x\n",sc_adapter[card]->devicename,
  64                 ((sc_adapter[card]->shmem_magic + ch * SRAM_PAGESIZE)>>14)|0x80);
  65         pr_debug("%s: copying %d bytes from %#x to %#x\n",
  66                 sc_adapter[card]->devicename, n,
  67                 (unsigned long) src,
  68                 sc_adapter[card]->rambase + ((unsigned long) dest %0x4000));
  69
  70         return ret;
  71 }
  72
  73 /*
  74  * Reverse of above
  75  */
  76 void *memcpy_fromshmem(int card, void *dest, const void *src, size_t n)
  77 {
  78         unsigned long flags;
  79         void *ret;
  80         unsigned char ch;
  81
  82         if(!IS_VALID_CARD(card)) {
  83                 pr_debug("Invalid param: %d is not a valid card id\n", card);
  84                 return NULL;
  85         }
  86
  87         if(n > SRAM_PAGESIZE) {
  88                 return NULL;
  89         }
  90
  91         /*
  92          * determine the page to load from the address
  93          */
  94         ch = (unsigned long) src / SRAM_PAGESIZE;
  95         pr_debug("%s: loaded page %d\n", sc_adapter[card]->devicename,ch);
  96
  97
  98         /*
  99          * Block interrupts and load the page
 100          */
 101         spin_lock_irqsave(&sc_adapter[card]->lock, flags);
 102
 103         outb(((sc_adapter[card]->shmem_magic + ch * SRAM_PAGESIZE) >> 14) | 0x80,
 104                 sc_adapter[card]->ioport[sc_adapter[card]->shmem_pgport]);
 105         ret = memcpy_fromio(dest,(void *)(sc_adapter[card]->rambase +
 106                 ((unsigned long) src % 0x4000)), n);
 107         spin_unlock_irqrestore(&sc_adapter[card]->lock, flags);
 108         pr_debug("%s: set page to %#x\n",sc_adapter[card]->devicename,
 109                 ((sc_adapter[card]->shmem_magic + ch * SRAM_PAGESIZE)>>14)|0x80);
 110 /*      pr_debug("%s: copying %d bytes from %#x to %#x\n",
 111                 sc_adapter[card]->devicename, n,
 112                 sc_adapter[card]->rambase + ((unsigned long) src %0x4000), (unsigned long) dest); */
 113
 114         return ret;
 115 }
 116
 117 void *memset_shmem(int card, void *dest, int c, size_t n)
 118 {
 119         unsigned long flags;
 120         unsigned char ch;
 121         void *ret;
 122
 123         if(!IS_VALID_CARD(card)) {
 124                 pr_debug("Invalid param: %d is not a valid card id\n", card);
 125                 return NULL;
 126         }
 127
 128         if(n > SRAM_PAGESIZE) {
 129                 return NULL;
 130         }
 131
 132         /*
 133          * determine the page to load from the address
 134          */
 135         ch = (unsigned long) dest / SRAM_PAGESIZE;
 136         pr_debug("%s: loaded page %d\n",sc_adapter[card]->devicename,ch);
 137
 138         /*
 139          * Block interrupts and load the page
 140          */
 141         spin_lock_irqsave(&sc_adapter[card]->lock, flags);
 142
 143         outb(((sc_adapter[card]->shmem_magic + ch * SRAM_PAGESIZE) >> 14) | 0x80,
 144                 sc_adapter[card]->ioport[sc_adapter[card]->shmem_pgport]);
 145         ret = memset_io(sc_adapter[card]->rambase +
 146                 ((unsigned long) dest % 0x4000), c, n);
 147         pr_debug("%s: set page to %#x\n",sc_adapter[card]->devicename,
 148                 ((sc_adapter[card]->shmem_magic + ch * SRAM_PAGESIZE)>>14)|0x80);
 149         spin_unlock_irqrestore(&sc_adapter[card]->lock, flags);
 150
 151         return ret;
 152 }