12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619 |
- /*
- * linux/sound/oss/dmasound/dmasound_atari.c
- *
- * Atari TT and Falcon DMA Sound Driver
- *
- * See linux/sound/oss/dmasound/dmasound_core.c for copyright and credits
- * prior to 28/01/2001
- *
- * 28/01/2001 [0.1] Iain Sandoe
- * - added versioning
- * - put in and populated the hardware_afmts field.
- * [0.2] - put in SNDCTL_DSP_GETCAPS value.
- * 01/02/2001 [0.3] - put in default hard/soft settings.
- */
- #include <linux/module.h>
- #include <linux/kernel.h>
- #include <linux/init.h>
- #include <linux/soundcard.h>
- #include <linux/mm.h>
- #include <linux/spinlock.h>
- #include <linux/interrupt.h>
- #include <asm/uaccess.h>
- #include <asm/atariints.h>
- #include <asm/atari_stram.h>
- #include "dmasound.h"
- #define DMASOUND_ATARI_REVISION 0
- #define DMASOUND_ATARI_EDITION 3
- extern void atari_microwire_cmd(int cmd);
- static int is_falcon;
- static int write_sq_ignore_int; /* ++TeSche: used for Falcon */
- static int expand_bal; /* Balance factor for expanding (not volume!) */
- static int expand_data; /* Data for expanding */
- /*** Translations ************************************************************/
- /* ++TeSche: radically changed for new expanding purposes...
- *
- * These two routines now deal with copying/expanding/translating the samples
- * from user space into our buffer at the right frequency. They take care about
- * how much data there's actually to read, how much buffer space there is and
- * to convert samples into the right frequency/encoding. They will only work on
- * complete samples so it may happen they leave some bytes in the input stream
- * if the user didn't write a multiple of the current sample size. They both
- * return the number of bytes they've used from both streams so you may detect
- * such a situation. Luckily all programs should be able to cope with that.
- *
- * I think I've optimized anything as far as one can do in plain C, all
- * variables should fit in registers and the loops are really short. There's
- * one loop for every possible situation. Writing a more generalized and thus
- * parameterized loop would only produce slower code. Feel free to optimize
- * this in assembler if you like. :)
- *
- * I think these routines belong here because they're not yet really hardware
- * independent, especially the fact that the Falcon can play 16bit samples
- * only in stereo is hardcoded in both of them!
- *
- * ++geert: split in even more functions (one per format)
- */
- static ssize_t ata_ct_law(const u_char __user *userPtr, size_t userCount,
- u_char frame[], ssize_t *frameUsed,
- ssize_t frameLeft);
- static ssize_t ata_ct_s8(const u_char __user *userPtr, size_t userCount,
- u_char frame[], ssize_t *frameUsed,
- ssize_t frameLeft);
- static ssize_t ata_ct_u8(const u_char __user *userPtr, size_t userCount,
- u_char frame[], ssize_t *frameUsed,
- ssize_t frameLeft);
- static ssize_t ata_ct_s16be(const u_char __user *userPtr, size_t userCount,
- u_char frame[], ssize_t *frameUsed,
- ssize_t frameLeft);
- static ssize_t ata_ct_u16be(const u_char __user *userPtr, size_t userCount,
- u_char frame[], ssize_t *frameUsed,
- ssize_t frameLeft);
- static ssize_t ata_ct_s16le(const u_char __user *userPtr, size_t userCount,
- u_char frame[], ssize_t *frameUsed,
- ssize_t frameLeft);
- static ssize_t ata_ct_u16le(const u_char __user *userPtr, size_t userCount,
- u_char frame[], ssize_t *frameUsed,
- ssize_t frameLeft);
- static ssize_t ata_ctx_law(const u_char __user *userPtr, size_t userCount,
- u_char frame[], ssize_t *frameUsed,
- ssize_t frameLeft);
- static ssize_t ata_ctx_s8(const u_char __user *userPtr, size_t userCount,
- u_char frame[], ssize_t *frameUsed,
- ssize_t frameLeft);
- static ssize_t ata_ctx_u8(const u_char __user *userPtr, size_t userCount,
- u_char frame[], ssize_t *frameUsed,
- ssize_t frameLeft);
- static ssize_t ata_ctx_s16be(const u_char __user *userPtr, size_t userCount,
- u_char frame[], ssize_t *frameUsed,
- ssize_t frameLeft);
- static ssize_t ata_ctx_u16be(const u_char __user *userPtr, size_t userCount,
- u_char frame[], ssize_t *frameUsed,
- ssize_t frameLeft);
- static ssize_t ata_ctx_s16le(const u_char __user *userPtr, size_t userCount,
- u_char frame[], ssize_t *frameUsed,
- ssize_t frameLeft);
- static ssize_t ata_ctx_u16le(const u_char __user *userPtr, size_t userCount,
- u_char frame[], ssize_t *frameUsed,
- ssize_t frameLeft);
- /*** Low level stuff *********************************************************/
- static void *AtaAlloc(unsigned int size, gfp_t flags);
- static void AtaFree(void *, unsigned int size);
- static int AtaIrqInit(void);
- #ifdef MODULE
- static void AtaIrqCleanUp(void);
- #endif /* MODULE */
- static int AtaSetBass(int bass);
- static int AtaSetTreble(int treble);
- static void TTSilence(void);
- static void TTInit(void);
- static int TTSetFormat(int format);
- static int TTSetVolume(int volume);
- static int TTSetGain(int gain);
- static void FalconSilence(void);
- static void FalconInit(void);
- static int FalconSetFormat(int format);
- static int FalconSetVolume(int volume);
- static void AtaPlayNextFrame(int index);
- static void AtaPlay(void);
- static irqreturn_t AtaInterrupt(int irq, void *dummy);
- /*** Mid level stuff *********************************************************/
- static void TTMixerInit(void);
- static void FalconMixerInit(void);
- static int AtaMixerIoctl(u_int cmd, u_long arg);
- static int TTMixerIoctl(u_int cmd, u_long arg);
- static int FalconMixerIoctl(u_int cmd, u_long arg);
- static int AtaWriteSqSetup(void);
- static int AtaSqOpen(fmode_t mode);
- static int TTStateInfo(char *buffer, size_t space);
- static int FalconStateInfo(char *buffer, size_t space);
- /*** Translations ************************************************************/
- static ssize_t ata_ct_law(const u_char __user *userPtr, size_t userCount,
- u_char frame[], ssize_t *frameUsed,
- ssize_t frameLeft)
- {
- char *table = dmasound.soft.format == AFMT_MU_LAW ? dmasound_ulaw2dma8
- : dmasound_alaw2dma8;
- ssize_t count, used;
- u_char *p = &frame[*frameUsed];
- count = min_t(unsigned long, userCount, frameLeft);
- if (dmasound.soft.stereo)
- count &= ~1;
- used = count;
- while (count > 0) {
- u_char data;
- if (get_user(data, userPtr++))
- return -EFAULT;
- *p++ = table[data];
- count--;
- }
- *frameUsed += used;
- return used;
- }
- static ssize_t ata_ct_s8(const u_char __user *userPtr, size_t userCount,
- u_char frame[], ssize_t *frameUsed,
- ssize_t frameLeft)
- {
- ssize_t count, used;
- void *p = &frame[*frameUsed];
- count = min_t(unsigned long, userCount, frameLeft);
- if (dmasound.soft.stereo)
- count &= ~1;
- used = count;
- if (copy_from_user(p, userPtr, count))
- return -EFAULT;
- *frameUsed += used;
- return used;
- }
- static ssize_t ata_ct_u8(const u_char __user *userPtr, size_t userCount,
- u_char frame[], ssize_t *frameUsed,
- ssize_t frameLeft)
- {
- ssize_t count, used;
- if (!dmasound.soft.stereo) {
- u_char *p = &frame[*frameUsed];
- count = min_t(unsigned long, userCount, frameLeft);
- used = count;
- while (count > 0) {
- u_char data;
- if (get_user(data, userPtr++))
- return -EFAULT;
- *p++ = data ^ 0x80;
- count--;
- }
- } else {
- u_short *p = (u_short *)&frame[*frameUsed];
- count = min_t(unsigned long, userCount, frameLeft)>>1;
- used = count*2;
- while (count > 0) {
- u_short data;
- if (get_user(data, (u_short __user *)userPtr))
- return -EFAULT;
- userPtr += 2;
- *p++ = data ^ 0x8080;
- count--;
- }
- }
- *frameUsed += used;
- return used;
- }
- static ssize_t ata_ct_s16be(const u_char __user *userPtr, size_t userCount,
- u_char frame[], ssize_t *frameUsed,
- ssize_t frameLeft)
- {
- ssize_t count, used;
- if (!dmasound.soft.stereo) {
- u_short *p = (u_short *)&frame[*frameUsed];
- count = min_t(unsigned long, userCount, frameLeft)>>1;
- used = count*2;
- while (count > 0) {
- u_short data;
- if (get_user(data, (u_short __user *)userPtr))
- return -EFAULT;
- userPtr += 2;
- *p++ = data;
- *p++ = data;
- count--;
- }
- *frameUsed += used*2;
- } else {
- void *p = (u_short *)&frame[*frameUsed];
- count = min_t(unsigned long, userCount, frameLeft) & ~3;
- used = count;
- if (copy_from_user(p, userPtr, count))
- return -EFAULT;
- *frameUsed += used;
- }
- return used;
- }
- static ssize_t ata_ct_u16be(const u_char __user *userPtr, size_t userCount,
- u_char frame[], ssize_t *frameUsed,
- ssize_t frameLeft)
- {
- ssize_t count, used;
- if (!dmasound.soft.stereo) {
- u_short *p = (u_short *)&frame[*frameUsed];
- count = min_t(unsigned long, userCount, frameLeft)>>1;
- used = count*2;
- while (count > 0) {
- u_short data;
- if (get_user(data, (u_short __user *)userPtr))
- return -EFAULT;
- userPtr += 2;
- data ^= 0x8000;
- *p++ = data;
- *p++ = data;
- count--;
- }
- *frameUsed += used*2;
- } else {
- u_long *p = (u_long *)&frame[*frameUsed];
- count = min_t(unsigned long, userCount, frameLeft)>>2;
- used = count*4;
- while (count > 0) {
- u_int data;
- if (get_user(data, (u_int __user *)userPtr))
- return -EFAULT;
- userPtr += 4;
- *p++ = data ^ 0x80008000;
- count--;
- }
- *frameUsed += used;
- }
- return used;
- }
- static ssize_t ata_ct_s16le(const u_char __user *userPtr, size_t userCount,
- u_char frame[], ssize_t *frameUsed,
- ssize_t frameLeft)
- {
- ssize_t count, used;
- count = frameLeft;
- if (!dmasound.soft.stereo) {
- u_short *p = (u_short *)&frame[*frameUsed];
- count = min_t(unsigned long, userCount, frameLeft)>>1;
- used = count*2;
- while (count > 0) {
- u_short data;
- if (get_user(data, (u_short __user *)userPtr))
- return -EFAULT;
- userPtr += 2;
- data = le2be16(data);
- *p++ = data;
- *p++ = data;
- count--;
- }
- *frameUsed += used*2;
- } else {
- u_long *p = (u_long *)&frame[*frameUsed];
- count = min_t(unsigned long, userCount, frameLeft)>>2;
- used = count*4;
- while (count > 0) {
- u_long data;
- if (get_user(data, (u_int __user *)userPtr))
- return -EFAULT;
- userPtr += 4;
- data = le2be16dbl(data);
- *p++ = data;
- count--;
- }
- *frameUsed += used;
- }
- return used;
- }
- static ssize_t ata_ct_u16le(const u_char __user *userPtr, size_t userCount,
- u_char frame[], ssize_t *frameUsed,
- ssize_t frameLeft)
- {
- ssize_t count, used;
- count = frameLeft;
- if (!dmasound.soft.stereo) {
- u_short *p = (u_short *)&frame[*frameUsed];
- count = min_t(unsigned long, userCount, frameLeft)>>1;
- used = count*2;
- while (count > 0) {
- u_short data;
- if (get_user(data, (u_short __user *)userPtr))
- return -EFAULT;
- userPtr += 2;
- data = le2be16(data) ^ 0x8000;
- *p++ = data;
- *p++ = data;
- }
- *frameUsed += used*2;
- } else {
- u_long *p = (u_long *)&frame[*frameUsed];
- count = min_t(unsigned long, userCount, frameLeft)>>2;
- used = count;
- while (count > 0) {
- u_long data;
- if (get_user(data, (u_int __user *)userPtr))
- return -EFAULT;
- userPtr += 4;
- data = le2be16dbl(data) ^ 0x80008000;
- *p++ = data;
- count--;
- }
- *frameUsed += used;
- }
- return used;
- }
- static ssize_t ata_ctx_law(const u_char __user *userPtr, size_t userCount,
- u_char frame[], ssize_t *frameUsed,
- ssize_t frameLeft)
- {
- char *table = dmasound.soft.format == AFMT_MU_LAW ? dmasound_ulaw2dma8
- : dmasound_alaw2dma8;
- /* this should help gcc to stuff everything into registers */
- long bal = expand_bal;
- long hSpeed = dmasound.hard.speed, sSpeed = dmasound.soft.speed;
- ssize_t used, usedf;
- used = userCount;
- usedf = frameLeft;
- if (!dmasound.soft.stereo) {
- u_char *p = &frame[*frameUsed];
- u_char data = expand_data;
- while (frameLeft) {
- u_char c;
- if (bal < 0) {
- if (!userCount)
- break;
- if (get_user(c, userPtr++))
- return -EFAULT;
- data = table[c];
- userCount--;
- bal += hSpeed;
- }
- *p++ = data;
- frameLeft--;
- bal -= sSpeed;
- }
- expand_data = data;
- } else {
- u_short *p = (u_short *)&frame[*frameUsed];
- u_short data = expand_data;
- while (frameLeft >= 2) {
- u_char c;
- if (bal < 0) {
- if (userCount < 2)
- break;
- if (get_user(c, userPtr++))
- return -EFAULT;
- data = table[c] << 8;
- if (get_user(c, userPtr++))
- return -EFAULT;
- data |= table[c];
- userCount -= 2;
- bal += hSpeed;
- }
- *p++ = data;
- frameLeft -= 2;
- bal -= sSpeed;
- }
- expand_data = data;
- }
- expand_bal = bal;
- used -= userCount;
- *frameUsed += usedf-frameLeft;
- return used;
- }
- static ssize_t ata_ctx_s8(const u_char __user *userPtr, size_t userCount,
- u_char frame[], ssize_t *frameUsed,
- ssize_t frameLeft)
- {
- /* this should help gcc to stuff everything into registers */
- long bal = expand_bal;
- long hSpeed = dmasound.hard.speed, sSpeed = dmasound.soft.speed;
- ssize_t used, usedf;
- used = userCount;
- usedf = frameLeft;
- if (!dmasound.soft.stereo) {
- u_char *p = &frame[*frameUsed];
- u_char data = expand_data;
- while (frameLeft) {
- if (bal < 0) {
- if (!userCount)
- break;
- if (get_user(data, userPtr++))
- return -EFAULT;
- userCount--;
- bal += hSpeed;
- }
- *p++ = data;
- frameLeft--;
- bal -= sSpeed;
- }
- expand_data = data;
- } else {
- u_short *p = (u_short *)&frame[*frameUsed];
- u_short data = expand_data;
- while (frameLeft >= 2) {
- if (bal < 0) {
- if (userCount < 2)
- break;
- if (get_user(data, (u_short __user *)userPtr))
- return -EFAULT;
- userPtr += 2;
- userCount -= 2;
- bal += hSpeed;
- }
- *p++ = data;
- frameLeft -= 2;
- bal -= sSpeed;
- }
- expand_data = data;
- }
- expand_bal = bal;
- used -= userCount;
- *frameUsed += usedf-frameLeft;
- return used;
- }
- static ssize_t ata_ctx_u8(const u_char __user *userPtr, size_t userCount,
- u_char frame[], ssize_t *frameUsed,
- ssize_t frameLeft)
- {
- /* this should help gcc to stuff everything into registers */
- long bal = expand_bal;
- long hSpeed = dmasound.hard.speed, sSpeed = dmasound.soft.speed;
- ssize_t used, usedf;
- used = userCount;
- usedf = frameLeft;
- if (!dmasound.soft.stereo) {
- u_char *p = &frame[*frameUsed];
- u_char data = expand_data;
- while (frameLeft) {
- if (bal < 0) {
- if (!userCount)
- break;
- if (get_user(data, userPtr++))
- return -EFAULT;
- data ^= 0x80;
- userCount--;
- bal += hSpeed;
- }
- *p++ = data;
- frameLeft--;
- bal -= sSpeed;
- }
- expand_data = data;
- } else {
- u_short *p = (u_short *)&frame[*frameUsed];
- u_short data = expand_data;
- while (frameLeft >= 2) {
- if (bal < 0) {
- if (userCount < 2)
- break;
- if (get_user(data, (u_short __user *)userPtr))
- return -EFAULT;
- userPtr += 2;
- data ^= 0x8080;
- userCount -= 2;
- bal += hSpeed;
- }
- *p++ = data;
- frameLeft -= 2;
- bal -= sSpeed;
- }
- expand_data = data;
- }
- expand_bal = bal;
- used -= userCount;
- *frameUsed += usedf-frameLeft;
- return used;
- }
- static ssize_t ata_ctx_s16be(const u_char __user *userPtr, size_t userCount,
- u_char frame[], ssize_t *frameUsed,
- ssize_t frameLeft)
- {
- /* this should help gcc to stuff everything into registers */
- long bal = expand_bal;
- long hSpeed = dmasound.hard.speed, sSpeed = dmasound.soft.speed;
- ssize_t used, usedf;
- used = userCount;
- usedf = frameLeft;
- if (!dmasound.soft.stereo) {
- u_short *p = (u_short *)&frame[*frameUsed];
- u_short data = expand_data;
- while (frameLeft >= 4) {
- if (bal < 0) {
- if (userCount < 2)
- break;
- if (get_user(data, (u_short __user *)userPtr))
- return -EFAULT;
- userPtr += 2;
- userCount -= 2;
- bal += hSpeed;
- }
- *p++ = data;
- *p++ = data;
- frameLeft -= 4;
- bal -= sSpeed;
- }
- expand_data = data;
- } else {
- u_long *p = (u_long *)&frame[*frameUsed];
- u_long data = expand_data;
- while (frameLeft >= 4) {
- if (bal < 0) {
- if (userCount < 4)
- break;
- if (get_user(data, (u_int __user *)userPtr))
- return -EFAULT;
- userPtr += 4;
- userCount -= 4;
- bal += hSpeed;
- }
- *p++ = data;
- frameLeft -= 4;
- bal -= sSpeed;
- }
- expand_data = data;
- }
- expand_bal = bal;
- used -= userCount;
- *frameUsed += usedf-frameLeft;
- return used;
- }
- static ssize_t ata_ctx_u16be(const u_char __user *userPtr, size_t userCount,
- u_char frame[], ssize_t *frameUsed,
- ssize_t frameLeft)
- {
- /* this should help gcc to stuff everything into registers */
- long bal = expand_bal;
- long hSpeed = dmasound.hard.speed, sSpeed = dmasound.soft.speed;
- ssize_t used, usedf;
- used = userCount;
- usedf = frameLeft;
- if (!dmasound.soft.stereo) {
- u_short *p = (u_short *)&frame[*frameUsed];
- u_short data = expand_data;
- while (frameLeft >= 4) {
- if (bal < 0) {
- if (userCount < 2)
- break;
- if (get_user(data, (u_short __user *)userPtr))
- return -EFAULT;
- userPtr += 2;
- data ^= 0x8000;
- userCount -= 2;
- bal += hSpeed;
- }
- *p++ = data;
- *p++ = data;
- frameLeft -= 4;
- bal -= sSpeed;
- }
- expand_data = data;
- } else {
- u_long *p = (u_long *)&frame[*frameUsed];
- u_long data = expand_data;
- while (frameLeft >= 4) {
- if (bal < 0) {
- if (userCount < 4)
- break;
- if (get_user(data, (u_int __user *)userPtr))
- return -EFAULT;
- userPtr += 4;
- data ^= 0x80008000;
- userCount -= 4;
- bal += hSpeed;
- }
- *p++ = data;
- frameLeft -= 4;
- bal -= sSpeed;
- }
- expand_data = data;
- }
- expand_bal = bal;
- used -= userCount;
- *frameUsed += usedf-frameLeft;
- return used;
- }
- static ssize_t ata_ctx_s16le(const u_char __user *userPtr, size_t userCount,
- u_char frame[], ssize_t *frameUsed,
- ssize_t frameLeft)
- {
- /* this should help gcc to stuff everything into registers */
- long bal = expand_bal;
- long hSpeed = dmasound.hard.speed, sSpeed = dmasound.soft.speed;
- ssize_t used, usedf;
- used = userCount;
- usedf = frameLeft;
- if (!dmasound.soft.stereo) {
- u_short *p = (u_short *)&frame[*frameUsed];
- u_short data = expand_data;
- while (frameLeft >= 4) {
- if (bal < 0) {
- if (userCount < 2)
- break;
- if (get_user(data, (u_short __user *)userPtr))
- return -EFAULT;
- userPtr += 2;
- data = le2be16(data);
- userCount -= 2;
- bal += hSpeed;
- }
- *p++ = data;
- *p++ = data;
- frameLeft -= 4;
- bal -= sSpeed;
- }
- expand_data = data;
- } else {
- u_long *p = (u_long *)&frame[*frameUsed];
- u_long data = expand_data;
- while (frameLeft >= 4) {
- if (bal < 0) {
- if (userCount < 4)
- break;
- if (get_user(data, (u_int __user *)userPtr))
- return -EFAULT;
- userPtr += 4;
- data = le2be16dbl(data);
- userCount -= 4;
- bal += hSpeed;
- }
- *p++ = data;
- frameLeft -= 4;
- bal -= sSpeed;
- }
- expand_data = data;
- }
- expand_bal = bal;
- used -= userCount;
- *frameUsed += usedf-frameLeft;
- return used;
- }
- static ssize_t ata_ctx_u16le(const u_char __user *userPtr, size_t userCount,
- u_char frame[], ssize_t *frameUsed,
- ssize_t frameLeft)
- {
- /* this should help gcc to stuff everything into registers */
- long bal = expand_bal;
- long hSpeed = dmasound.hard.speed, sSpeed = dmasound.soft.speed;
- ssize_t used, usedf;
- used = userCount;
- usedf = frameLeft;
- if (!dmasound.soft.stereo) {
- u_short *p = (u_short *)&frame[*frameUsed];
- u_short data = expand_data;
- while (frameLeft >= 4) {
- if (bal < 0) {
- if (userCount < 2)
- break;
- if (get_user(data, (u_short __user *)userPtr))
- return -EFAULT;
- userPtr += 2;
- data = le2be16(data) ^ 0x8000;
- userCount -= 2;
- bal += hSpeed;
- }
- *p++ = data;
- *p++ = data;
- frameLeft -= 4;
- bal -= sSpeed;
- }
- expand_data = data;
- } else {
- u_long *p = (u_long *)&frame[*frameUsed];
- u_long data = expand_data;
- while (frameLeft >= 4) {
- if (bal < 0) {
- if (userCount < 4)
- break;
- if (get_user(data, (u_int __user *)userPtr))
- return -EFAULT;
- userPtr += 4;
- data = le2be16dbl(data) ^ 0x80008000;
- userCount -= 4;
- bal += hSpeed;
- }
- *p++ = data;
- frameLeft -= 4;
- bal -= sSpeed;
- }
- expand_data = data;
- }
- expand_bal = bal;
- used -= userCount;
- *frameUsed += usedf-frameLeft;
- return used;
- }
- static TRANS transTTNormal = {
- .ct_ulaw = ata_ct_law,
- .ct_alaw = ata_ct_law,
- .ct_s8 = ata_ct_s8,
- .ct_u8 = ata_ct_u8,
- };
- static TRANS transTTExpanding = {
- .ct_ulaw = ata_ctx_law,
- .ct_alaw = ata_ctx_law,
- .ct_s8 = ata_ctx_s8,
- .ct_u8 = ata_ctx_u8,
- };
- static TRANS transFalconNormal = {
- .ct_ulaw = ata_ct_law,
- .ct_alaw = ata_ct_law,
- .ct_s8 = ata_ct_s8,
- .ct_u8 = ata_ct_u8,
- .ct_s16be = ata_ct_s16be,
- .ct_u16be = ata_ct_u16be,
- .ct_s16le = ata_ct_s16le,
- .ct_u16le = ata_ct_u16le
- };
- static TRANS transFalconExpanding = {
- .ct_ulaw = ata_ctx_law,
- .ct_alaw = ata_ctx_law,
- .ct_s8 = ata_ctx_s8,
- .ct_u8 = ata_ctx_u8,
- .ct_s16be = ata_ctx_s16be,
- .ct_u16be = ata_ctx_u16be,
- .ct_s16le = ata_ctx_s16le,
- .ct_u16le = ata_ctx_u16le,
- };
- /*** Low level stuff *********************************************************/
- /*
- * Atari (TT/Falcon)
- */
- static void *AtaAlloc(unsigned int size, gfp_t flags)
- {
- return atari_stram_alloc(size, "dmasound");
- }
- static void AtaFree(void *obj, unsigned int size)
- {
- atari_stram_free( obj );
- }
- static int __init AtaIrqInit(void)
- {
- /* Set up timer A. Timer A
- will receive a signal upon end of playing from the sound
- hardware. Furthermore Timer A is able to count events
- and will cause an interrupt after a programmed number
- of events. So all we need to keep the music playing is
- to provide the sound hardware with new data upon
- an interrupt from timer A. */
- st_mfp.tim_ct_a = 0; /* ++roman: Stop timer before programming! */
- st_mfp.tim_dt_a = 1; /* Cause interrupt after first event. */
- st_mfp.tim_ct_a = 8; /* Turn on event counting. */
- /* Register interrupt handler. */
- if (request_irq(IRQ_MFP_TIMA, AtaInterrupt, IRQ_TYPE_SLOW, "DMA sound",
- AtaInterrupt))
- return 0;
- st_mfp.int_en_a |= 0x20; /* Turn interrupt on. */
- st_mfp.int_mk_a |= 0x20;
- return 1;
- }
- #ifdef MODULE
- static void AtaIrqCleanUp(void)
- {
- st_mfp.tim_ct_a = 0; /* stop timer */
- st_mfp.int_en_a &= ~0x20; /* turn interrupt off */
- free_irq(IRQ_MFP_TIMA, AtaInterrupt);
- }
- #endif /* MODULE */
- #define TONE_VOXWARE_TO_DB(v) \
- (((v) < 0) ? -12 : ((v) > 100) ? 12 : ((v) - 50) * 6 / 25)
- #define TONE_DB_TO_VOXWARE(v) (((v) * 25 + ((v) > 0 ? 5 : -5)) / 6 + 50)
- static int AtaSetBass(int bass)
- {
- dmasound.bass = TONE_VOXWARE_TO_DB(bass);
- atari_microwire_cmd(MW_LM1992_BASS(dmasound.bass));
- return TONE_DB_TO_VOXWARE(dmasound.bass);
- }
- static int AtaSetTreble(int treble)
- {
- dmasound.treble = TONE_VOXWARE_TO_DB(treble);
- atari_microwire_cmd(MW_LM1992_TREBLE(dmasound.treble));
- return TONE_DB_TO_VOXWARE(dmasound.treble);
- }
- /*
- * TT
- */
- static void TTSilence(void)
- {
- tt_dmasnd.ctrl = DMASND_CTRL_OFF;
- atari_microwire_cmd(MW_LM1992_PSG_HIGH); /* mix in PSG signal 1:1 */
- }
- static void TTInit(void)
- {
- int mode, i, idx;
- const int freq[4] = {50066, 25033, 12517, 6258};
- /* search a frequency that fits into the allowed error range */
- idx = -1;
- for (i = 0; i < ARRAY_SIZE(freq); i++)
- /* this isn't as much useful for a TT than for a Falcon, but
- * then it doesn't hurt very much to implement it for a TT too.
- */
- if ((100 * abs(dmasound.soft.speed - freq[i]) / freq[i]) < catchRadius)
- idx = i;
- if (idx > -1) {
- dmasound.soft.speed = freq[idx];
- dmasound.trans_write = &transTTNormal;
- } else
- dmasound.trans_write = &transTTExpanding;
- TTSilence();
- dmasound.hard = dmasound.soft;
- if (dmasound.hard.speed > 50066) {
- /* we would need to squeeze the sound, but we won't do that */
- dmasound.hard.speed = 50066;
- mode = DMASND_MODE_50KHZ;
- dmasound.trans_write = &transTTNormal;
- } else if (dmasound.hard.speed > 25033) {
- dmasound.hard.speed = 50066;
- mode = DMASND_MODE_50KHZ;
- } else if (dmasound.hard.speed > 12517) {
- dmasound.hard.speed = 25033;
- mode = DMASND_MODE_25KHZ;
- } else if (dmasound.hard.speed > 6258) {
- dmasound.hard.speed = 12517;
- mode = DMASND_MODE_12KHZ;
- } else {
- dmasound.hard.speed = 6258;
- mode = DMASND_MODE_6KHZ;
- }
- tt_dmasnd.mode = (dmasound.hard.stereo ?
- DMASND_MODE_STEREO : DMASND_MODE_MONO) |
- DMASND_MODE_8BIT | mode;
- expand_bal = -dmasound.soft.speed;
- }
- static int TTSetFormat(int format)
- {
- /* TT sound DMA supports only 8bit modes */
- switch (format) {
- case AFMT_QUERY:
- return dmasound.soft.format;
- case AFMT_MU_LAW:
- case AFMT_A_LAW:
- case AFMT_S8:
- case AFMT_U8:
- break;
- default:
- format = AFMT_S8;
- }
- dmasound.soft.format = format;
- dmasound.soft.size = 8;
- if (dmasound.minDev == SND_DEV_DSP) {
- dmasound.dsp.format = format;
- dmasound.dsp.size = 8;
- }
- TTInit();
- return format;
- }
- #define VOLUME_VOXWARE_TO_DB(v) \
- (((v) < 0) ? -40 : ((v) > 100) ? 0 : ((v) * 2) / 5 - 40)
- #define VOLUME_DB_TO_VOXWARE(v) ((((v) + 40) * 5 + 1) / 2)
- static int TTSetVolume(int volume)
- {
- dmasound.volume_left = VOLUME_VOXWARE_TO_DB(volume & 0xff);
- atari_microwire_cmd(MW_LM1992_BALLEFT(dmasound.volume_left));
- dmasound.volume_right = VOLUME_VOXWARE_TO_DB((volume & 0xff00) >> 8);
- atari_microwire_cmd(MW_LM1992_BALRIGHT(dmasound.volume_right));
- return VOLUME_DB_TO_VOXWARE(dmasound.volume_left) |
- (VOLUME_DB_TO_VOXWARE(dmasound.volume_right) << 8);
- }
- #define GAIN_VOXWARE_TO_DB(v) \
- (((v) < 0) ? -80 : ((v) > 100) ? 0 : ((v) * 4) / 5 - 80)
- #define GAIN_DB_TO_VOXWARE(v) ((((v) + 80) * 5 + 1) / 4)
- static int TTSetGain(int gain)
- {
- dmasound.gain = GAIN_VOXWARE_TO_DB(gain);
- atari_microwire_cmd(MW_LM1992_VOLUME(dmasound.gain));
- return GAIN_DB_TO_VOXWARE(dmasound.gain);
- }
- /*
- * Falcon
- */
- static void FalconSilence(void)
- {
- /* stop playback, set sample rate 50kHz for PSG sound */
- tt_dmasnd.ctrl = DMASND_CTRL_OFF;
- tt_dmasnd.mode = DMASND_MODE_50KHZ | DMASND_MODE_STEREO | DMASND_MODE_8BIT;
- tt_dmasnd.int_div = 0; /* STE compatible divider */
- tt_dmasnd.int_ctrl = 0x0;
- tt_dmasnd.cbar_src = 0x0000; /* no matrix inputs */
- tt_dmasnd.cbar_dst = 0x0000; /* no matrix outputs */
- tt_dmasnd.dac_src = 1; /* connect ADC to DAC, disconnect matrix */
- tt_dmasnd.adc_src = 3; /* ADC Input = PSG */
- }
- static void FalconInit(void)
- {
- int divider, i, idx;
- const int freq[8] = {49170, 32780, 24585, 19668, 16390, 12292, 9834, 8195};
- /* search a frequency that fits into the allowed error range */
- idx = -1;
- for (i = 0; i < ARRAY_SIZE(freq); i++)
- /* if we will tolerate 3% error 8000Hz->8195Hz (2.38%) would
- * be playable without expanding, but that now a kernel runtime
- * option
- */
- if ((100 * abs(dmasound.soft.speed - freq[i]) / freq[i]) < catchRadius)
- idx = i;
- if (idx > -1) {
- dmasound.soft.speed = freq[idx];
- dmasound.trans_write = &transFalconNormal;
- } else
- dmasound.trans_write = &transFalconExpanding;
- FalconSilence();
- dmasound.hard = dmasound.soft;
- if (dmasound.hard.size == 16) {
- /* the Falcon can play 16bit samples only in stereo */
- dmasound.hard.stereo = 1;
- }
- if (dmasound.hard.speed > 49170) {
- /* we would need to squeeze the sound, but we won't do that */
- dmasound.hard.speed = 49170;
- divider = 1;
- dmasound.trans_write = &transFalconNormal;
- } else if (dmasound.hard.speed > 32780) {
- dmasound.hard.speed = 49170;
- divider = 1;
- } else if (dmasound.hard.speed > 24585) {
- dmasound.hard.speed = 32780;
- divider = 2;
- } else if (dmasound.hard.speed > 19668) {
- dmasound.hard.speed = 24585;
- divider = 3;
- } else if (dmasound.hard.speed > 16390) {
- dmasound.hard.speed = 19668;
- divider = 4;
- } else if (dmasound.hard.speed > 12292) {
- dmasound.hard.speed = 16390;
- divider = 5;
- } else if (dmasound.hard.speed > 9834) {
- dmasound.hard.speed = 12292;
- divider = 7;
- } else if (dmasound.hard.speed > 8195) {
- dmasound.hard.speed = 9834;
- divider = 9;
- } else {
- dmasound.hard.speed = 8195;
- divider = 11;
- }
- tt_dmasnd.int_div = divider;
- /* Setup Falcon sound DMA for playback */
- tt_dmasnd.int_ctrl = 0x4; /* Timer A int at play end */
- tt_dmasnd.track_select = 0x0; /* play 1 track, track 1 */
- tt_dmasnd.cbar_src = 0x0001; /* DMA(25MHz) --> DAC */
- tt_dmasnd.cbar_dst = 0x0000;
- tt_dmasnd.rec_track_select = 0;
- tt_dmasnd.dac_src = 2; /* connect matrix to DAC */
- tt_dmasnd.adc_src = 0; /* ADC Input = Mic */
- tt_dmasnd.mode = (dmasound.hard.stereo ?
- DMASND_MODE_STEREO : DMASND_MODE_MONO) |
- ((dmasound.hard.size == 8) ?
- DMASND_MODE_8BIT : DMASND_MODE_16BIT) |
- DMASND_MODE_6KHZ;
- expand_bal = -dmasound.soft.speed;
- }
- static int FalconSetFormat(int format)
- {
- int size;
- /* Falcon sound DMA supports 8bit and 16bit modes */
- switch (format) {
- case AFMT_QUERY:
- return dmasound.soft.format;
- case AFMT_MU_LAW:
- case AFMT_A_LAW:
- case AFMT_U8:
- case AFMT_S8:
- size = 8;
- break;
- case AFMT_S16_BE:
- case AFMT_U16_BE:
- case AFMT_S16_LE:
- case AFMT_U16_LE:
- size = 16;
- break;
- default: /* :-) */
- size = 8;
- format = AFMT_S8;
- }
- dmasound.soft.format = format;
- dmasound.soft.size = size;
- if (dmasound.minDev == SND_DEV_DSP) {
- dmasound.dsp.format = format;
- dmasound.dsp.size = dmasound.soft.size;
- }
- FalconInit();
- return format;
- }
- /* This is for the Falcon output *attenuation* in 1.5dB steps,
- * i.e. output level from 0 to -22.5dB in -1.5dB steps.
- */
- #define VOLUME_VOXWARE_TO_ATT(v) \
- ((v) < 0 ? 15 : (v) > 100 ? 0 : 15 - (v) * 3 / 20)
- #define VOLUME_ATT_TO_VOXWARE(v) (100 - (v) * 20 / 3)
- static int FalconSetVolume(int volume)
- {
- dmasound.volume_left = VOLUME_VOXWARE_TO_ATT(volume & 0xff);
- dmasound.volume_right = VOLUME_VOXWARE_TO_ATT((volume & 0xff00) >> 8);
- tt_dmasnd.output_atten = dmasound.volume_left << 8 | dmasound.volume_right << 4;
- return VOLUME_ATT_TO_VOXWARE(dmasound.volume_left) |
- VOLUME_ATT_TO_VOXWARE(dmasound.volume_right) << 8;
- }
- static void AtaPlayNextFrame(int index)
- {
- char *start, *end;
- /* used by AtaPlay() if all doubts whether there really is something
- * to be played are already wiped out.
- */
- start = write_sq.buffers[write_sq.front];
- end = start+((write_sq.count == index) ? write_sq.rear_size
- : write_sq.block_size);
- /* end might not be a legal virtual address. */
- DMASNDSetEnd(virt_to_phys(end - 1) + 1);
- DMASNDSetBase(virt_to_phys(start));
- /* Since only an even number of samples per frame can
- be played, we might lose one byte here. (TO DO) */
- write_sq.front = (write_sq.front+1) % write_sq.max_count;
- write_sq.active++;
- tt_dmasnd.ctrl = DMASND_CTRL_ON | DMASND_CTRL_REPEAT;
- }
- static void AtaPlay(void)
- {
- /* ++TeSche: Note that write_sq.active is no longer just a flag but
- * holds the number of frames the DMA is currently programmed for
- * instead, may be 0, 1 (currently being played) or 2 (pre-programmed).
- *
- * Changes done to write_sq.count and write_sq.active are a bit more
- * subtle again so now I must admit I also prefer disabling the irq
- * here rather than considering all possible situations. But the point
- * is that disabling the irq doesn't have any bad influence on this
- * version of the driver as we benefit from having pre-programmed the
- * DMA wherever possible: There's no need to reload the DMA at the
- * exact time of an interrupt but only at some time while the
- * pre-programmed frame is playing!
- */
- atari_disable_irq(IRQ_MFP_TIMA);
- if (write_sq.active == 2 || /* DMA is 'full' */
- write_sq.count <= 0) { /* nothing to do */
- atari_enable_irq(IRQ_MFP_TIMA);
- return;
- }
- if (write_sq.active == 0) {
- /* looks like there's nothing 'in' the DMA yet, so try
- * to put two frames into it (at least one is available).
- */
- if (write_sq.count == 1 &&
- write_sq.rear_size < write_sq.block_size &&
- !write_sq.syncing) {
- /* hmmm, the only existing frame is not
- * yet filled and we're not syncing?
- */
- atari_enable_irq(IRQ_MFP_TIMA);
- return;
- }
- AtaPlayNextFrame(1);
- if (write_sq.count == 1) {
- /* no more frames */
- atari_enable_irq(IRQ_MFP_TIMA);
- return;
- }
- if (write_sq.count == 2 &&
- write_sq.rear_size < write_sq.block_size &&
- !write_sq.syncing) {
- /* hmmm, there were two frames, but the second
- * one is not yet filled and we're not syncing?
- */
- atari_enable_irq(IRQ_MFP_TIMA);
- return;
- }
- AtaPlayNextFrame(2);
- } else {
- /* there's already a frame being played so we may only stuff
- * one new into the DMA, but even if this may be the last
- * frame existing the previous one is still on write_sq.count.
- */
- if (write_sq.count == 2 &&
- write_sq.rear_size < write_sq.block_size &&
- !write_sq.syncing) {
- /* hmmm, the only existing frame is not
- * yet filled and we're not syncing?
- */
- atari_enable_irq(IRQ_MFP_TIMA);
- return;
- }
- AtaPlayNextFrame(2);
- }
- atari_enable_irq(IRQ_MFP_TIMA);
- }
- static irqreturn_t AtaInterrupt(int irq, void *dummy)
- {
- #if 0
- /* ++TeSche: if you should want to test this... */
- static int cnt;
- if (write_sq.active == 2)
- if (++cnt == 10) {
- /* simulate losing an interrupt */
- cnt = 0;
- return IRQ_HANDLED;
- }
- #endif
- spin_lock(&dmasound.lock);
- if (write_sq_ignore_int && is_falcon) {
- /* ++TeSche: Falcon only: ignore first irq because it comes
- * immediately after starting a frame. after that, irqs come
- * (almost) like on the TT.
- */
- write_sq_ignore_int = 0;
- return IRQ_HANDLED;
- }
- if (!write_sq.active) {
- /* playing was interrupted and sq_reset() has already cleared
- * the sq variables, so better don't do anything here.
- */
- WAKE_UP(write_sq.sync_queue);
- return IRQ_HANDLED;
- }
- /* Probably ;) one frame is finished. Well, in fact it may be that a
- * pre-programmed one is also finished because there has been a long
- * delay in interrupt delivery and we've completely lost one, but
- * there's no way to detect such a situation. In such a case the last
- * frame will be played more than once and the situation will recover
- * as soon as the irq gets through.
- */
- write_sq.count--;
- write_sq.active--;
- if (!write_sq.active) {
- tt_dmasnd.ctrl = DMASND_CTRL_OFF;
- write_sq_ignore_int = 1;
- }
- WAKE_UP(write_sq.action_queue);
- /* At least one block of the queue is free now
- so wake up a writing process blocked because
- of a full queue. */
- if ((write_sq.active != 1) || (write_sq.count != 1))
- /* We must be a bit carefully here: write_sq.count indicates the
- * number of buffers used and not the number of frames to be
- * played. If write_sq.count==1 and write_sq.active==1 that
- * means the only remaining frame was already programmed
- * earlier (and is currently running) so we mustn't call
- * AtaPlay() here, otherwise we'll play one frame too much.
- */
- AtaPlay();
- if (!write_sq.active) WAKE_UP(write_sq.sync_queue);
- /* We are not playing after AtaPlay(), so there
- is nothing to play any more. Wake up a process
- waiting for audio output to drain. */
- spin_unlock(&dmasound.lock);
- return IRQ_HANDLED;
- }
- /*** Mid level stuff *********************************************************/
- /*
- * /dev/mixer abstraction
- */
- #define RECLEVEL_VOXWARE_TO_GAIN(v) \
- ((v) < 0 ? 0 : (v) > 100 ? 15 : (v) * 3 / 20)
- #define RECLEVEL_GAIN_TO_VOXWARE(v) (((v) * 20 + 2) / 3)
- static void __init TTMixerInit(void)
- {
- atari_microwire_cmd(MW_LM1992_VOLUME(0));
- dmasound.volume_left = 0;
- atari_microwire_cmd(MW_LM1992_BALLEFT(0));
- dmasound.volume_right = 0;
- atari_microwire_cmd(MW_LM1992_BALRIGHT(0));
- atari_microwire_cmd(MW_LM1992_TREBLE(0));
- atari_microwire_cmd(MW_LM1992_BASS(0));
- }
- static void __init FalconMixerInit(void)
- {
- dmasound.volume_left = (tt_dmasnd.output_atten & 0xf00) >> 8;
- dmasound.volume_right = (tt_dmasnd.output_atten & 0xf0) >> 4;
- }
- static int AtaMixerIoctl(u_int cmd, u_long arg)
- {
- int data;
- unsigned long flags;
- switch (cmd) {
- case SOUND_MIXER_READ_SPEAKER:
- if (is_falcon || MACH_IS_TT) {
- int porta;
- spin_lock_irqsave(&dmasound.lock, flags);
- sound_ym.rd_data_reg_sel = 14;
- porta = sound_ym.rd_data_reg_sel;
- spin_unlock_irqrestore(&dmasound.lock, flags);
- return IOCTL_OUT(arg, porta & 0x40 ? 0 : 100);
- }
- break;
- case SOUND_MIXER_WRITE_VOLUME:
- IOCTL_IN(arg, data);
- return IOCTL_OUT(arg, dmasound_set_volume(data));
- case SOUND_MIXER_WRITE_SPEAKER:
- if (is_falcon || MACH_IS_TT) {
- int porta;
- IOCTL_IN(arg, data);
- spin_lock_irqsave(&dmasound.lock, flags);
- sound_ym.rd_data_reg_sel = 14;
- porta = (sound_ym.rd_data_reg_sel & ~0x40) |
- (data < 50 ? 0x40 : 0);
- sound_ym.wd_data = porta;
- spin_unlock_irqrestore(&dmasound.lock, flags);
- return IOCTL_OUT(arg, porta & 0x40 ? 0 : 100);
- }
- }
- return -EINVAL;
- }
- static int TTMixerIoctl(u_int cmd, u_long arg)
- {
- int data;
- switch (cmd) {
- case SOUND_MIXER_READ_RECMASK:
- return IOCTL_OUT(arg, 0);
- case SOUND_MIXER_READ_DEVMASK:
- return IOCTL_OUT(arg,
- SOUND_MASK_VOLUME | SOUND_MASK_TREBLE | SOUND_MASK_BASS |
- (MACH_IS_TT ? SOUND_MASK_SPEAKER : 0));
- case SOUND_MIXER_READ_STEREODEVS:
- return IOCTL_OUT(arg, SOUND_MASK_VOLUME);
- case SOUND_MIXER_READ_VOLUME:
- return IOCTL_OUT(arg,
- VOLUME_DB_TO_VOXWARE(dmasound.volume_left) |
- (VOLUME_DB_TO_VOXWARE(dmasound.volume_right) << 8));
- case SOUND_MIXER_READ_BASS:
- return IOCTL_OUT(arg, TONE_DB_TO_VOXWARE(dmasound.bass));
- case SOUND_MIXER_READ_TREBLE:
- return IOCTL_OUT(arg, TONE_DB_TO_VOXWARE(dmasound.treble));
- case SOUND_MIXER_READ_OGAIN:
- return IOCTL_OUT(arg, GAIN_DB_TO_VOXWARE(dmasound.gain));
- case SOUND_MIXER_WRITE_BASS:
- IOCTL_IN(arg, data);
- return IOCTL_OUT(arg, dmasound_set_bass(data));
- case SOUND_MIXER_WRITE_TREBLE:
- IOCTL_IN(arg, data);
- return IOCTL_OUT(arg, dmasound_set_treble(data));
- case SOUND_MIXER_WRITE_OGAIN:
- IOCTL_IN(arg, data);
- return IOCTL_OUT(arg, dmasound_set_gain(data));
- }
- return AtaMixerIoctl(cmd, arg);
- }
- static int FalconMixerIoctl(u_int cmd, u_long arg)
- {
- int data;
- switch (cmd) {
- case SOUND_MIXER_READ_RECMASK:
- return IOCTL_OUT(arg, SOUND_MASK_MIC);
- case SOUND_MIXER_READ_DEVMASK:
- return IOCTL_OUT(arg, SOUND_MASK_VOLUME | SOUND_MASK_MIC | SOUND_MASK_SPEAKER);
- case SOUND_MIXER_READ_STEREODEVS:
- return IOCTL_OUT(arg, SOUND_MASK_VOLUME | SOUND_MASK_MIC);
- case SOUND_MIXER_READ_VOLUME:
- return IOCTL_OUT(arg,
- VOLUME_ATT_TO_VOXWARE(dmasound.volume_left) |
- VOLUME_ATT_TO_VOXWARE(dmasound.volume_right) << 8);
- case SOUND_MIXER_READ_CAPS:
- return IOCTL_OUT(arg, SOUND_CAP_EXCL_INPUT);
- case SOUND_MIXER_WRITE_MIC:
- IOCTL_IN(arg, data);
- tt_dmasnd.input_gain =
- RECLEVEL_VOXWARE_TO_GAIN(data & 0xff) << 4 |
- RECLEVEL_VOXWARE_TO_GAIN(data >> 8 & 0xff);
- /* fall thru, return set value */
- case SOUND_MIXER_READ_MIC:
- return IOCTL_OUT(arg,
- RECLEVEL_GAIN_TO_VOXWARE(tt_dmasnd.input_gain >> 4 & 0xf) |
- RECLEVEL_GAIN_TO_VOXWARE(tt_dmasnd.input_gain & 0xf) << 8);
- }
- return AtaMixerIoctl(cmd, arg);
- }
- static int AtaWriteSqSetup(void)
- {
- write_sq_ignore_int = 0;
- return 0 ;
- }
- static int AtaSqOpen(fmode_t mode)
- {
- write_sq_ignore_int = 1;
- return 0 ;
- }
- static int TTStateInfo(char *buffer, size_t space)
- {
- int len = 0;
- len += sprintf(buffer+len, "\tvol left %ddB [-40... 0]\n",
- dmasound.volume_left);
- len += sprintf(buffer+len, "\tvol right %ddB [-40... 0]\n",
- dmasound.volume_right);
- len += sprintf(buffer+len, "\tbass %ddB [-12...+12]\n",
- dmasound.bass);
- len += sprintf(buffer+len, "\ttreble %ddB [-12...+12]\n",
- dmasound.treble);
- if (len >= space) {
- printk(KERN_ERR "dmasound_atari: overflowed state buffer alloc.\n") ;
- len = space ;
- }
- return len;
- }
- static int FalconStateInfo(char *buffer, size_t space)
- {
- int len = 0;
- len += sprintf(buffer+len, "\tvol left %ddB [-22.5 ... 0]\n",
- dmasound.volume_left);
- len += sprintf(buffer+len, "\tvol right %ddB [-22.5 ... 0]\n",
- dmasound.volume_right);
- if (len >= space) {
- printk(KERN_ERR "dmasound_atari: overflowed state buffer alloc.\n") ;
- len = space ;
- }
- return len;
- }
- /*** Machine definitions *****************************************************/
- static SETTINGS def_hard_falcon = {
- .format = AFMT_S8,
- .stereo = 0,
- .size = 8,
- .speed = 8195
- } ;
- static SETTINGS def_hard_tt = {
- .format = AFMT_S8,
- .stereo = 0,
- .size = 8,
- .speed = 12517
- } ;
- static SETTINGS def_soft = {
- .format = AFMT_U8,
- .stereo = 0,
- .size = 8,
- .speed = 8000
- } ;
- static __initdata MACHINE machTT = {
- .name = "Atari",
- .name2 = "TT",
- .owner = THIS_MODULE,
- .dma_alloc = AtaAlloc,
- .dma_free = AtaFree,
- .irqinit = AtaIrqInit,
- #ifdef MODULE
- .irqcleanup = AtaIrqCleanUp,
- #endif /* MODULE */
- .init = TTInit,
- .silence = TTSilence,
- .setFormat = TTSetFormat,
- .setVolume = TTSetVolume,
- .setBass = AtaSetBass,
- .setTreble = AtaSetTreble,
- .setGain = TTSetGain,
- .play = AtaPlay,
- .mixer_init = TTMixerInit,
- .mixer_ioctl = TTMixerIoctl,
- .write_sq_setup = AtaWriteSqSetup,
- .sq_open = AtaSqOpen,
- .state_info = TTStateInfo,
- .min_dsp_speed = 6258,
- .version = ((DMASOUND_ATARI_REVISION<<8) | DMASOUND_ATARI_EDITION),
- .hardware_afmts = AFMT_S8, /* h'ware-supported formats *only* here */
- .capabilities = DSP_CAP_BATCH /* As per SNDCTL_DSP_GETCAPS */
- };
- static __initdata MACHINE machFalcon = {
- .name = "Atari",
- .name2 = "FALCON",
- .dma_alloc = AtaAlloc,
- .dma_free = AtaFree,
- .irqinit = AtaIrqInit,
- #ifdef MODULE
- .irqcleanup = AtaIrqCleanUp,
- #endif /* MODULE */
- .init = FalconInit,
- .silence = FalconSilence,
- .setFormat = FalconSetFormat,
- .setVolume = FalconSetVolume,
- .setBass = AtaSetBass,
- .setTreble = AtaSetTreble,
- .play = AtaPlay,
- .mixer_init = FalconMixerInit,
- .mixer_ioctl = FalconMixerIoctl,
- .write_sq_setup = AtaWriteSqSetup,
- .sq_open = AtaSqOpen,
- .state_info = FalconStateInfo,
- .min_dsp_speed = 8195,
- .version = ((DMASOUND_ATARI_REVISION<<8) | DMASOUND_ATARI_EDITION),
- .hardware_afmts = (AFMT_S8 | AFMT_S16_BE), /* h'ware-supported formats *only* here */
- .capabilities = DSP_CAP_BATCH /* As per SNDCTL_DSP_GETCAPS */
- };
- /*** Config & Setup **********************************************************/
- static int __init dmasound_atari_init(void)
- {
- if (MACH_IS_ATARI && ATARIHW_PRESENT(PCM_8BIT)) {
- if (ATARIHW_PRESENT(CODEC)) {
- dmasound.mach = machFalcon;
- dmasound.mach.default_soft = def_soft ;
- dmasound.mach.default_hard = def_hard_falcon ;
- is_falcon = 1;
- } else if (ATARIHW_PRESENT(MICROWIRE)) {
- dmasound.mach = machTT;
- dmasound.mach.default_soft = def_soft ;
- dmasound.mach.default_hard = def_hard_tt ;
- is_falcon = 0;
- } else
- return -ENODEV;
- if ((st_mfp.int_en_a & st_mfp.int_mk_a & 0x20) == 0)
- return dmasound_init();
- else {
- printk("DMA sound driver: Timer A interrupt already in use\n");
- return -EBUSY;
- }
- }
- return -ENODEV;
- }
- static void __exit dmasound_atari_cleanup(void)
- {
- dmasound_deinit();
- }
- module_init(dmasound_atari_init);
- module_exit(dmasound_atari_cleanup);
- MODULE_LICENSE("GPL");
|