shmem.c
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:4k
- /* $Id: shmem.c,v 1.1.4.1 2001/11/20 14:19:37 kai Exp $
- *
- * Copyright (C) 1996 SpellCaster Telecommunications Inc.
- *
- * Card functions implementing ISDN4Linux functionality
- *
- * This software may be used and distributed according to the terms
- * of the GNU General Public License, incorporated herein by reference.
- *
- * For more information, please contact gpl-info@spellcast.com or write:
- *
- * SpellCaster Telecommunications Inc.
- * 5621 Finch Avenue East, Unit #3
- * Scarborough, Ontario Canada
- * M1B 2T9
- * +1 (416) 297-8565
- * +1 (416) 297-6433 Facsimile
- */
- #define __NO_VERSION__
- #include "includes.h" /* This must be first */
- #include "hardware.h"
- #include "card.h"
- /*
- * Main adapter array
- */
- extern board *adapter[];
- extern int cinst;
- /*
- *
- */
- void *memcpy_toshmem(int card, void *dest, const void *src, size_t n)
- {
- unsigned long flags;
- void *ret;
- unsigned char ch;
- if(!IS_VALID_CARD(card)) {
- pr_debug("Invalid param: %d is not a valid card idn", card);
- return NULL;
- }
- if(n > SRAM_PAGESIZE) {
- return NULL;
- }
- /*
- * determine the page to load from the address
- */
- ch = (unsigned long) dest / SRAM_PAGESIZE;
- pr_debug("%s: loaded page %dn",adapter[card]->devicename,ch);
- /*
- * Block interrupts and load the page
- */
- save_flags(flags);
- cli();
- outb(((adapter[card]->shmem_magic + ch * SRAM_PAGESIZE) >> 14) | 0x80,
- adapter[card]->ioport[adapter[card]->shmem_pgport]);
- pr_debug("%s: set page to %#xn",adapter[card]->devicename,
- ((adapter[card]->shmem_magic + ch * SRAM_PAGESIZE)>>14)|0x80);
- ret = memcpy_toio(adapter[card]->rambase +
- ((unsigned long) dest % 0x4000), src, n);
- pr_debug("%s: copying %d bytes from %#x to %#xn",adapter[card]->devicename, n,
- (unsigned long) src, adapter[card]->rambase + ((unsigned long) dest %0x4000));
- restore_flags(flags);
- return ret;
- }
- /*
- * Reverse of above
- */
- void *memcpy_fromshmem(int card, void *dest, const void *src, size_t n)
- {
- unsigned long flags;
- void *ret;
- unsigned char ch;
- if(!IS_VALID_CARD(card)) {
- pr_debug("Invalid param: %d is not a valid card idn", card);
- return NULL;
- }
- if(n > SRAM_PAGESIZE) {
- return NULL;
- }
- /*
- * determine the page to load from the address
- */
- ch = (unsigned long) src / SRAM_PAGESIZE;
- pr_debug("%s: loaded page %dn",adapter[card]->devicename,ch);
-
-
- /*
- * Block interrupts and load the page
- */
- save_flags(flags);
- cli();
- outb(((adapter[card]->shmem_magic + ch * SRAM_PAGESIZE) >> 14) | 0x80,
- adapter[card]->ioport[adapter[card]->shmem_pgport]);
- pr_debug("%s: set page to %#xn",adapter[card]->devicename,
- ((adapter[card]->shmem_magic + ch * SRAM_PAGESIZE)>>14)|0x80);
- ret = memcpy_fromio(dest,(void *)(adapter[card]->rambase +
- ((unsigned long) src % 0x4000)), n);
- /* pr_debug("%s: copying %d bytes from %#x to %#xn",
- adapter[card]->devicename, n,
- adapter[card]->rambase + ((unsigned long) src %0x4000), (unsigned long) dest); */
- restore_flags(flags);
- return ret;
- }
- void *memset_shmem(int card, void *dest, int c, size_t n)
- {
- unsigned long flags;
- unsigned char ch;
- void *ret;
- if(!IS_VALID_CARD(card)) {
- pr_debug("Invalid param: %d is not a valid card idn", card);
- return NULL;
- }
- if(n > SRAM_PAGESIZE) {
- return NULL;
- }
- /*
- * determine the page to load from the address
- */
- ch = (unsigned long) dest / SRAM_PAGESIZE;
- pr_debug("%s: loaded page %dn",adapter[card]->devicename,ch);
- /*
- * Block interrupts and load the page
- */
- save_flags(flags);
- cli();
- outb(((adapter[card]->shmem_magic + ch * SRAM_PAGESIZE) >> 14) | 0x80,
- adapter[card]->ioport[adapter[card]->shmem_pgport]);
- pr_debug("%s: set page to %#xn",adapter[card]->devicename,
- ((adapter[card]->shmem_magic + ch * SRAM_PAGESIZE)>>14)|0x80);
- ret = memset_io(adapter[card]->rambase +
- ((unsigned long) dest % 0x4000), c, n);
- restore_flags(flags);
- return ret;
- }