[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / isdn / sc / shmem.c

/* $Id: shmem.c,v 1.2.10.1 2001/09/23 22:24:59 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
 */

#include "includes.h"		/* This must be first */
#include "hardware.h"
#include "card.h"

/*
 *
 */
void memcpy_toshmem(int card, void *dest, const void *src, size_t n)
{
	unsigned long flags;
	unsigned char ch;
	unsigned long dest_rem = ((unsigned long) dest) % 0x4000;

	if (!IS_VALID_CARD(card)) {
		pr_debug("Invalid param: %d is not a valid card id\n", card);
		return;
	}

	if (n > SRAM_PAGESIZE)
		return;

	/*
	 * determine the page to load from the address
	 */
	ch = (unsigned long) dest / SRAM_PAGESIZE;
	pr_debug("%s: loaded page %d\n", sc_adapter[card]->devicename, ch);
	/*
	 * Block interrupts and load the page
	 */
	spin_lock_irqsave(&sc_adapter[card]->lock, flags);

	outb(((sc_adapter[card]->shmem_magic + ch * SRAM_PAGESIZE) >> 14) | 0x80,
	     sc_adapter[card]->ioport[sc_adapter[card]->shmem_pgport]);
	memcpy_toio((void __iomem *)(sc_adapter[card]->rambase + dest_rem), src, n);
	spin_unlock_irqrestore(&sc_adapter[card]->lock, flags);
	pr_debug("%s: set page to %#x\n", sc_adapter[card]->devicename,
		 ((sc_adapter[card]->shmem_magic + ch * SRAM_PAGESIZE) >> 14) | 0x80);
	pr_debug("%s: copying %zu bytes from %#lx to %#lx\n",
		 sc_adapter[card]->devicename, n,
		 (unsigned long) src,
		 sc_adapter[card]->rambase + ((unsigned long) dest % 0x4000));
}

/*
 * Reverse of above
 */
void memcpy_fromshmem(int card, void *dest, const void *src, size_t n)
{
	unsigned long flags;
	unsigned char ch;

	if (!IS_VALID_CARD(card)) {
		pr_debug("Invalid param: %d is not a valid card id\n", card);
		return;
	}

	if (n > SRAM_PAGESIZE) {
		return;
	}

	/*
	 * determine the page to load from the address
	 */
	ch = (unsigned long) src / SRAM_PAGESIZE;
	pr_debug("%s: loaded page %d\n", sc_adapter[card]->devicename, ch);


	/*
	 * Block interrupts and load the page
	 */
	spin_lock_irqsave(&sc_adapter[card]->lock, flags);

	outb(((sc_adapter[card]->shmem_magic + ch * SRAM_PAGESIZE) >> 14) | 0x80,
	     sc_adapter[card]->ioport[sc_adapter[card]->shmem_pgport]);
	memcpy_fromio(dest, (void *)(sc_adapter[card]->rambase +
				     ((unsigned long) src % 0x4000)), n);
	spin_unlock_irqrestore(&sc_adapter[card]->lock, flags);
	pr_debug("%s: set page to %#x\n", sc_adapter[card]->devicename,
		 ((sc_adapter[card]->shmem_magic + ch * SRAM_PAGESIZE) >> 14) | 0x80);
/*	pr_debug("%s: copying %d bytes from %#x to %#x\n",
	sc_adapter[card]->devicename, n,
	sc_adapter[card]->rambase + ((unsigned long) src %0x4000), (unsigned long) dest); */
}

#if 0
void memset_shmem(int card, void *dest, int c, size_t n)
{
	unsigned long flags;
	unsigned char ch;

	if (!IS_VALID_CARD(card)) {
		pr_debug("Invalid param: %d is not a valid card id\n", card);
		return;
	}

	if (n > SRAM_PAGESIZE) {
		return;
	}

	/*
	 * determine the page to load from the address
	 */
	ch = (unsigned long) dest / SRAM_PAGESIZE;
	pr_debug("%s: loaded page %d\n", sc_adapter[card]->devicename, ch);

	/*
	 * Block interrupts and load the page
	 */
	spin_lock_irqsave(&sc_adapter[card]->lock, flags);

	outb(((sc_adapter[card]->shmem_magic + ch * SRAM_PAGESIZE) >> 14) | 0x80,
	     sc_adapter[card]->ioport[sc_adapter[card]->shmem_pgport]);
	memset_io(sc_adapter[card]->rambase +
		  ((unsigned long) dest % 0x4000), c, n);
	pr_debug("%s: set page to %#x\n", sc_adapter[card]->devicename,
		 ((sc_adapter[card]->shmem_magic + ch * SRAM_PAGESIZE) >> 14) | 0x80);
	spin_unlock_irqrestore(&sc_adapter[card]->lock, flags);
}
#endif  /*  0  */
Commit	Line	Data
1da177e4 LT	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
1da177e4 LT	24	/*
	25	*
	26	*/
	27	void memcpy_toshmem(int card, void dest, const void src, size_t n)
	28	{
	29	unsigned long flags;
	30	unsigned char ch;
9317d431	31	unsigned long dest_rem = ((unsigned long) dest) % 0x4000;
1da177e4	32
9317d431	33	if (!IS_VALID_CARD(card)) {
1da177e4 LT	34	pr_debug("Invalid param: %d is not a valid card id\n", card);
	35	return;
	36	}
	37
9317d431	38	if (n > SRAM_PAGESIZE)
1da177e4	39	return;
1da177e4 LT	40
	41	/*
	42	* determine the page to load from the address
	43	*/
	44	ch = (unsigned long) dest / SRAM_PAGESIZE;
475be4d8	45	pr_debug("%s: loaded page %d\n", sc_adapter[card]->devicename, ch);
1da177e4 LT	46	/*
	47	* Block interrupts and load the page
	48	*/
	49	spin_lock_irqsave(&sc_adapter[card]->lock, flags);
	50
	51	outb(((sc_adapter[card]->shmem_magic + ch * SRAM_PAGESIZE) >> 14) \| 0x80,
475be4d8	52	sc_adapter[card]->ioport[sc_adapter[card]->shmem_pgport]);
66ba8862	53	memcpy_toio((void __iomem *)(sc_adapter[card]->rambase + dest_rem), src, n);
1da177e4	54	spin_unlock_irqrestore(&sc_adapter[card]->lock, flags);
475be4d8 JP	55	pr_debug("%s: set page to %#x\n", sc_adapter[card]->devicename,
475be4d8 JP	56	((sc_adapter[card]->shmem_magic + ch * SRAM_PAGESIZE) >> 14) \| 0x80);
0d5048a9	57	pr_debug("%s: copying %zu bytes from %#lx to %#lx\n",
475be4d8 JP	58	sc_adapter[card]->devicename, n,
	59	(unsigned long) src,
	60	sc_adapter[card]->rambase + ((unsigned long) dest % 0x4000));
1da177e4 LT	61	}
	62
	63	/*
	64	* Reverse of above
	65	*/
	66	void memcpy_fromshmem(int card, void dest, const void src, size_t n)
	67	{
	68	unsigned long flags;
	69	unsigned char ch;
	70
475be4d8	71	if (!IS_VALID_CARD(card)) {
1da177e4 LT	72	pr_debug("Invalid param: %d is not a valid card id\n", card);
	73	return;
	74	}
	75
475be4d8	76	if (n > SRAM_PAGESIZE) {
1da177e4 LT	77	return;
	78	}
	79
	80	/*
	81	* determine the page to load from the address
	82	*/
	83	ch = (unsigned long) src / SRAM_PAGESIZE;
475be4d8 JP	84	pr_debug("%s: loaded page %d\n", sc_adapter[card]->devicename, ch);
	85
	86
1da177e4 LT	87	/*
	88	* Block interrupts and load the page
	89	*/
	90	spin_lock_irqsave(&sc_adapter[card]->lock, flags);
	91
	92	outb(((sc_adapter[card]->shmem_magic + ch * SRAM_PAGESIZE) >> 14) \| 0x80,
475be4d8 JP	93	sc_adapter[card]->ioport[sc_adapter[card]->shmem_pgport]);
	94	memcpy_fromio(dest, (void *)(sc_adapter[card]->rambase +
	95	((unsigned long) src % 0x4000)), n);
1da177e4	96	spin_unlock_irqrestore(&sc_adapter[card]->lock, flags);
475be4d8 JP	97	pr_debug("%s: set page to %#x\n", sc_adapter[card]->devicename,
475be4d8 JP	98	((sc_adapter[card]->shmem_magic + ch * SRAM_PAGESIZE) >> 14) \| 0x80);
1da177e4	99	/* pr_debug("%s: copying %d bytes from %#x to %#x\n",
475be4d8 JP	100	sc_adapter[card]->devicename, n,
475be4d8 JP	101	sc_adapter[card]->rambase + ((unsigned long) src %0x4000), (unsigned long) dest); */
1da177e4 LT	102	}
1da177e4 LT	103
e3ca5e76	104	#if 0
1da177e4 LT	105	void memset_shmem(int card, void *dest, int c, size_t n)
	106	{
	107	unsigned long flags;
	108	unsigned char ch;
	109
475be4d8	110	if (!IS_VALID_CARD(card)) {
1da177e4 LT	111	pr_debug("Invalid param: %d is not a valid card id\n", card);
	112	return;
	113	}
	114
475be4d8	115	if (n > SRAM_PAGESIZE) {
1da177e4 LT	116	return;
	117	}
	118
	119	/*
	120	* determine the page to load from the address
	121	*/
	122	ch = (unsigned long) dest / SRAM_PAGESIZE;
475be4d8	123	pr_debug("%s: loaded page %d\n", sc_adapter[card]->devicename, ch);
1da177e4 LT	124
	125	/*
	126	* Block interrupts and load the page
	127	*/
	128	spin_lock_irqsave(&sc_adapter[card]->lock, flags);
	129
	130	outb(((sc_adapter[card]->shmem_magic + ch * SRAM_PAGESIZE) >> 14) \| 0x80,
475be4d8	131	sc_adapter[card]->ioport[sc_adapter[card]->shmem_pgport]);
1da177e4	132	memset_io(sc_adapter[card]->rambase +
475be4d8 JP	133	((unsigned long) dest % 0x4000), c, n);
	134	pr_debug("%s: set page to %#x\n", sc_adapter[card]->devicename,
	135	((sc_adapter[card]->shmem_magic + ch * SRAM_PAGESIZE) >> 14) \| 0x80);
1da177e4 LT	136	spin_unlock_irqrestore(&sc_adapter[card]->lock, flags);
1da177e4 LT	137	}
e3ca5e76	138	#endif /* 0 */