Subversion Repositories or1k

/*

 *  $Id: shmem.c,v 1.1 2005-12-20 10:17:12 jcastillo Exp $

 *  Copyright (C) 1996  SpellCaster Telecommunications Inc.

 *

 *  card.c - Card functions implementing ISDN4Linux functionality

 *

 *  This program is free software; you can redistribute it and/or modify

 *  it under the terms of the GNU General Public License as published by

 *  the Free Software Foundation; either version 2 of the License, or

 *  (at your option) any later version.

 *

 *  This program is distributed in the hope that it will be useful,

 *  but WITHOUT ANY WARRANTY; without even the implied warranty of

 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

 *  GNU General Public License for more details.

 *

 *  You should have received a copy of the GNU General Public License

 *  along with this program; if not, write to the Free Software

 *  Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.

 *

 *  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 id\n", 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 %d\n",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 %#x\n",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 %#x\n",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 id\n", 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 %d\n",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 %#x\n",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 %#x\n",

                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 id\n", 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 %d\n",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 %#x\n",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;

}