shmem.c
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:4k
源码类别:

嵌入式Linux

开发平台:

Unix_Linux

  1. /* $Id: shmem.c,v 1.1.4.1 2001/11/20 14:19:37 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. #define __NO_VERSION__
  20. #include "includes.h" /* This must be first */
  21. #include "hardware.h"
  22. #include "card.h"
  23. /*
  24.  * Main adapter array
  25.  */
  26. extern board *adapter[];
  27. extern int cinst;
  28. /*
  29.  *
  30.  */
  31. void *memcpy_toshmem(int card, void *dest, const void *src, size_t n)
  32. {
  33. unsigned long flags;
  34. void *ret;
  35. unsigned char ch;
  36. if(!IS_VALID_CARD(card)) {
  37. pr_debug("Invalid param: %d is not a valid card idn", card);
  38. return NULL;
  39. }
  40. if(n > SRAM_PAGESIZE) {
  41. return NULL;
  42. }
  43. /*
  44.  * determine the page to load from the address
  45.  */
  46. ch = (unsigned long) dest / SRAM_PAGESIZE;
  47. pr_debug("%s: loaded page %dn",adapter[card]->devicename,ch);
  48. /*
  49.  * Block interrupts and load the page
  50.  */
  51. save_flags(flags);
  52. cli();
  53. outb(((adapter[card]->shmem_magic + ch * SRAM_PAGESIZE) >> 14) | 0x80,
  54. adapter[card]->ioport[adapter[card]->shmem_pgport]);
  55. pr_debug("%s: set page to %#xn",adapter[card]->devicename,
  56. ((adapter[card]->shmem_magic + ch * SRAM_PAGESIZE)>>14)|0x80);
  57. ret = memcpy_toio(adapter[card]->rambase + 
  58. ((unsigned long) dest % 0x4000), src, n);
  59. pr_debug("%s: copying %d bytes from %#x to %#xn",adapter[card]->devicename, n,
  60.  (unsigned long) src, adapter[card]->rambase + ((unsigned long) dest %0x4000));
  61. restore_flags(flags);
  62. return ret;
  63. }
  64. /*
  65.  * Reverse of above
  66.  */
  67. void *memcpy_fromshmem(int card, void *dest, const void *src, size_t n)
  68. {
  69. unsigned long flags;
  70. void *ret;
  71. unsigned char ch;
  72. if(!IS_VALID_CARD(card)) {
  73. pr_debug("Invalid param: %d is not a valid card idn", card);
  74. return NULL;
  75. }
  76. if(n > SRAM_PAGESIZE) {
  77. return NULL;
  78. }
  79. /*
  80.  * determine the page to load from the address
  81.  */
  82. ch = (unsigned long) src / SRAM_PAGESIZE;
  83. pr_debug("%s: loaded page %dn",adapter[card]->devicename,ch);
  84. /*
  85.  * Block interrupts and load the page
  86.  */
  87. save_flags(flags);
  88. cli();
  89. outb(((adapter[card]->shmem_magic + ch * SRAM_PAGESIZE) >> 14) | 0x80,
  90. adapter[card]->ioport[adapter[card]->shmem_pgport]);
  91. pr_debug("%s: set page to %#xn",adapter[card]->devicename,
  92. ((adapter[card]->shmem_magic + ch * SRAM_PAGESIZE)>>14)|0x80);
  93. ret = memcpy_fromio(dest,(void *)(adapter[card]->rambase + 
  94. ((unsigned long) src % 0x4000)), n);
  95. /* pr_debug("%s: copying %d bytes from %#x to %#xn",
  96. adapter[card]->devicename, n,
  97. adapter[card]->rambase + ((unsigned long) src %0x4000), (unsigned long) dest); */
  98. restore_flags(flags);
  99. return ret;
  100. }
  101. void *memset_shmem(int card, void *dest, int c, size_t n)
  102. {
  103. unsigned long flags;
  104. unsigned char ch;
  105. void *ret;
  106. if(!IS_VALID_CARD(card)) {
  107. pr_debug("Invalid param: %d is not a valid card idn", card);
  108. return NULL;
  109. }
  110. if(n > SRAM_PAGESIZE) {
  111. return NULL;
  112. }
  113. /*
  114.  * determine the page to load from the address
  115.  */
  116. ch = (unsigned long) dest / SRAM_PAGESIZE;
  117. pr_debug("%s: loaded page %dn",adapter[card]->devicename,ch);
  118. /*
  119.  * Block interrupts and load the page
  120.  */
  121. save_flags(flags);
  122. cli();
  123. outb(((adapter[card]->shmem_magic + ch * SRAM_PAGESIZE) >> 14) | 0x80,
  124. adapter[card]->ioport[adapter[card]->shmem_pgport]);
  125. pr_debug("%s: set page to %#xn",adapter[card]->devicename,
  126. ((adapter[card]->shmem_magic + ch * SRAM_PAGESIZE)>>14)|0x80);
  127. ret = memset_io(adapter[card]->rambase + 
  128. ((unsigned long) dest % 0x4000), c, n);
  129. restore_flags(flags);
  130. return ret;
  131. }