1 /* $NetBSD: dma.c,v 1.3 1995/04/30 12:04:48 leo Exp $ */ 2 3 /* 4 * Copyright (c) 1995 Leo Weppelman. 5 * All rights reserved. 6 * 7 * Redistribution and use in source and binary forms, with or without 8 * modification, are permitted provided that the following conditions 9 * are met: 10 * 1. Redistributions of source code must retain the above copyright 11 * notice, this list of conditions and the following disclaimer. 12 * 2. Redistributions in binary form must reproduce the above copyright 13 * notice, this list of conditions and the following disclaimer in the 14 * documentation and/or other materials provided with the distribution. 15 * 3. All advertising materials mentioning features or use of this software 16 * must display the following acknowledgement: 17 * This product includes software developed by Leo Weppelman. 18 * 4. The name of the author may not be used to endorse or promote products 19 * derived from this software without specific prior written permission 20 * 21 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 22 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 23 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 24 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 25 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 26 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 27 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 28 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 29 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 30 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 31 */ 32 33 /* 34 * This file contains special code dealing with the DMA interface 35 * on the Atari ST. 36 * 37 * The DMA circuitry requires some special treatment for the peripheral 38 * devices which make use of the ST's DMA feature (the hard disk and the 39 * floppy drive). 40 * All devices using DMA need mutually exclusive access and can follow some 41 * standard pattern which will be provided in this file. 42 * 43 * The file contains the following entry points: 44 * 45 * st_dmagrab: ensure exclusive access to the DMA circuitry 46 * st_dmafree: free exclusive access to the DMA circuitry 47 * st_dmawanted: somebody is queued waiting for DMA-access 48 * dmaint: DMA interrupt routine, switches to the current driver 49 * st_dmaaddr: specify 24 bit RAM address 50 * st_dmacomm: program DMA, flush FIFO first 51 */ 52 53 #include <sys/param.h> 54 #include <sys/systm.h> 55 #include <sys/kernel.h> 56 #include <sys/queue.h> 57 #include <machine/cpu.h> 58 #include <machine/iomap.h> 59 #include <machine/dma.h> 60 61 #define NDMA_DEV 10 /* Max 2 floppy's, 8 hard-disks */ 62 typedef struct dma_entry { 63 TAILQ_ENTRY(dma_entry) entries; /* List pointers */ 64 void (*call_func)(); /* Call when lock granted */ 65 void (*int_func)(); /* Call on DMA interrupt */ 66 void *softc; /* Arg. to int_func */ 67 int *lock_stat; /* status of DMA lock */ 68 } DMA_ENTRY; 69 70 /* 71 * Preallocated entries. An allocator seem an overkill here. 72 */ 73 static DMA_ENTRY dmatable[NDMA_DEV]; /* preallocated entries */ 74 static int sched_soft = 0; /* callback scheduled */ 75 76 /* 77 * Heads of free and active lists: 78 */ 79 static TAILQ_HEAD(freehead, dma_entry) dma_free; 80 static TAILQ_HEAD(acthead, dma_entry) dma_active; 81 82 static int must_init = 1; /* Must initialize */ 83 84 static void cdmasoft __P((void)); 85 static void init_queues __P((void)); 86 87 static void init_queues() 88 { 89 int i; 90 91 TAILQ_INIT(&dma_free); 92 TAILQ_INIT(&dma_active); 93 94 for(i = 0; i < NDMA_DEV; i++) 95 TAILQ_INSERT_HEAD(&dma_free, &dmatable[i], entries); 96 } 97 98 int st_dmagrab(int_func, call_func, softc, lock_stat, rcaller) 99 void (*int_func)(); 100 void (*call_func)(); 101 void *softc; 102 int *lock_stat; 103 int rcaller; 104 { 105 int sps; 106 DMA_ENTRY *req; 107 108 if(must_init) { 109 init_queues(); 110 must_init = 0; 111 } 112 *lock_stat = DMA_LOCK_REQ; 113 114 sps = splhigh(); 115 116 /* 117 * Create a request... 118 */ 119 if(dma_free.tqh_first == NULL) 120 panic("st_dmagrab: Too many outstanding requests\n"); 121 req = dma_free.tqh_first; 122 TAILQ_REMOVE(&dma_free, dma_free.tqh_first, entries); 123 req->call_func = call_func; 124 req->int_func = int_func; 125 req->softc = softc; 126 req->lock_stat = lock_stat; 127 TAILQ_INSERT_TAIL(&dma_active, req, entries); 128 129 if(dma_active.tqh_first != req) { 130 splx(sps); 131 return(0); 132 } 133 splx(sps); 134 135 /* 136 * We're at the head of the queue, ergo: we got the lock. 137 */ 138 *lock_stat = DMA_LOCK_GRANT; 139 140 if(rcaller) { 141 /* 142 * Just return to caller immediately without going 143 * through 'call_func' first. 144 */ 145 return(1); 146 } 147 148 (*call_func)(softc); /* Call followup function */ 149 return(0); 150 } 151 152 void 153 st_dmafree(softc, lock_stat) 154 void *softc; 155 int *lock_stat; 156 { 157 int sps; 158 DMA_ENTRY *req; 159 160 sps = splhigh(); 161 162 /* 163 * Some validity checks first. 164 */ 165 if((req = dma_active.tqh_first) == NULL) 166 panic("st_dmafree: empty active queue\n"); 167 if(req->softc != softc) 168 printf("Caller of st_dmafree is not lock-owner!\n"); 169 170 /* 171 * Clear lock status, move request from active to free queue. 172 */ 173 *lock_stat = 0; 174 TAILQ_REMOVE(&dma_active, req, entries); 175 TAILQ_INSERT_HEAD(&dma_free, req, entries); 176 177 if((req = dma_active.tqh_first) != NULL) { 178 /* 179 * Call next request through softint handler. This avoids 180 * spl-conflicts. 181 */ 182 *req->lock_stat = DMA_LOCK_GRANT; 183 add_sicallback(req->call_func, req->softc, 0); 184 } 185 splx(sps); 186 return; 187 } 188 189 int 190 st_dmawanted() 191 { 192 return(dma_active.tqh_first->entries.tqe_next != NULL); 193 } 194 195 cdmaint(sr) 196 long sr; /* sr at time of interrupt */ 197 { 198 if(dma_active.tqh_first != NULL) { 199 if(!BASEPRI(sr)) { 200 if(!sched_soft++) 201 add_sicallback(cdmasoft, 0, 0); 202 } 203 else { 204 spl1(); 205 cdmasoft(); 206 } 207 } 208 else printf("DMA interrupt discarded\n"); 209 } 210 211 static void cdmasoft() 212 { 213 sched_soft = 0; 214 (*dma_active.tqh_first->int_func)(dma_active.tqh_first->softc); 215 } 216 217 /* 218 * Setup address for DMA-transfer. 219 * Note: The order _is_ important! 220 */ 221 void 222 st_dmaaddr(address) 223 caddr_t address; 224 { 225 register u_long ad = (u_long)address; 226 227 DMA->dma_addr[AD_LOW ] = (ad ) & 0xff; 228 DMA->dma_addr[AD_MID ] = (ad >> 8) & 0xff; 229 DMA->dma_addr[AD_HIGH] = (ad >>16) & 0xff; 230 } 231 232 /* 233 * Program the DMA-controller to transfer 'nblk' blocks of 512 bytes. 234 * The DMA_WRBIT trick flushes the FIFO before doing DMA. 235 */ 236 void 237 st_dmacomm(mode, data) 238 int mode, data; 239 { 240 DMA->dma_mode = mode; 241 DMA->dma_mode = mode ^ DMA_WRBIT; 242 DMA->dma_mode = mode; 243 DMA->dma_data = data; 244 } 245