1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621 |
- /*
- * 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;
- goto out;
- }
- 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);
- goto out;
- }
- /* 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. */
- out:
- 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");
|