Skip to content

Commit

Permalink
bgm_xyscope: simplify alsa probing
Browse files Browse the repository at this point in the history
  • Loading branch information
@fridtjof
fridtjof committed Jan 1, 2025
1 parent 8d06b9e commit 5ab3ebb
Showing 1 changed file with 45 additions and 79 deletions.
124 changes: 45 additions & 79 deletions src/modules/bgm_xyscope.c
View file
Original file line number Diff line number Diff line change
Expand Up @@ -30,11 +30,12 @@ enum samplesize {

static snd_pcm_t * scope_pcm;
// Details on the sample format before conversion.
// Two-channel (enables XY mode), if not, acts like a primitive X oscilloscope
static int sf_2c;
// channel count - 2 enables XY mode, 1 acts like a primitive X oscilloscope
static int sf_chancount;
// xy mode, uses two channels
static int sf_usey;
static enum samplesize sf_sampsize;
static int sf_us;
static int sf_usey;
static int sf_forceon;

static int camera_width;
Expand Down Expand Up @@ -62,10 +63,10 @@ static oscore_task scope_task;
#define SM_ALGORITHM(sample, shr, sub) (((byte) (sample >> shr)) - sub)
#define LD_ALGORITHM(typ, shr, sub) \
for (int indx = 0; indx < BUFFER_FRAMES; indx++) { \
typ sampleA = ((typ *) bufferA)[indx * (sf_2c ? 2 : 1)]; \
typ sampleA = ((typ *) bufferA)[indx * sf_chancount]; \
bufferB[indx * 2] = SM_ALGORITHM(sampleA, shr, sub); \
if (sf_2c && sf_usey) { \
typ sampleB = ((typ *) bufferA)[(indx * (sf_2c ? 2 : 1)) + 1]; \
if (sf_chancount == 2 && sf_usey) { \
typ sampleB = ((typ *) bufferA)[(indx * sf_chancount) + 1]; \
bufferB[(indx * 2) + 1] = 255 - SM_ALGORITHM(sampleB, shr, sub); \
} else { \
bufferB[(indx * 2) + 1] = bufferB[indx * 2]; \
Expand Down Expand Up @@ -246,97 +247,62 @@ int init(int modulen, char* argstr) {
return 1;
}
free(ourarg);
sf_2c = 0;

sf_sampsize = SIZE_8;
sf_us = 0;
if (sf_usey) {
if (!(code = snd_pcm_set_params(scope_pcm, SND_PCM_FORMAT_S8, SND_PCM_ACCESS_RW_INTERLEAVED, 2, SAMPLE_RATE, 1, 1000))) {
printf("Got BS8C2\n");
sf_2c = 1;
} else if (!(code = snd_pcm_set_params(scope_pcm, SND_PCM_FORMAT_S16, SND_PCM_ACCESS_RW_INTERLEAVED, 2, SAMPLE_RATE, 1, 1000))) {
printf("Got BS16C2\n");
sf_sampsize = SIZE_16;
sf_2c = 1;
} else if (!(code = snd_pcm_set_params(scope_pcm, SND_PCM_FORMAT_S24, SND_PCM_ACCESS_RW_INTERLEAVED, 2, SAMPLE_RATE, 1, 1000))) {
printf("Got BS24C2\n");
sf_sampsize = SIZE_24;
sf_2c = 1;
} else if (!(code = snd_pcm_set_params(scope_pcm, SND_PCM_FORMAT_S32, SND_PCM_ACCESS_RW_INTERLEAVED, 2, SAMPLE_RATE, 1, 1000))) {
printf("Got BS32C2\n");
sf_sampsize = SIZE_32;
sf_2c = 1;
} else if (!(code = snd_pcm_set_params(scope_pcm, SND_PCM_FORMAT_U8, SND_PCM_ACCESS_RW_INTERLEAVED, 2, SAMPLE_RATE, 1, 1000))) {
printf("Got BU8C2\n");
sf_2c = 1;
sf_us = 1;
} else if (!(code = snd_pcm_set_params(scope_pcm, SND_PCM_FORMAT_U16, SND_PCM_ACCESS_RW_INTERLEAVED, 2, SAMPLE_RATE, 1, 1000))) {
printf("Got BU16C2\n");
sf_sampsize = SIZE_16;
sf_2c = 1;
sf_us = 1;
} else if (!(code = snd_pcm_set_params(scope_pcm, SND_PCM_FORMAT_U24, SND_PCM_ACCESS_RW_INTERLEAVED, 2, SAMPLE_RATE, 1, 1000))) {
printf("Got BU24C2\n");
sf_sampsize = SIZE_24;
sf_2c = 1;
sf_us = 1;
} else if (!(code = snd_pcm_set_params(scope_pcm, SND_PCM_FORMAT_U32, SND_PCM_ACCESS_RW_INTERLEAVED, 2, SAMPLE_RATE, 1, 1000))) {
printf("Got BU32C2\n");
sf_sampsize = SIZE_32;
sf_2c = 1;
sf_us = 1;
}
} else {
if (!(code = snd_pcm_set_params(scope_pcm, SND_PCM_FORMAT_S8, SND_PCM_ACCESS_RW_INTERLEAVED, 1, SAMPLE_RATE, 1, 1000))) {
printf("Got BS8C1\n");
} else if (!(code = snd_pcm_set_params(scope_pcm, SND_PCM_FORMAT_S16, SND_PCM_ACCESS_RW_INTERLEAVED, 1, SAMPLE_RATE, 1, 1000))) {
printf("Got BS16C1\n");
sf_sampsize = SIZE_16;
} else if (!(code = snd_pcm_set_params(scope_pcm, SND_PCM_FORMAT_S24, SND_PCM_ACCESS_RW_INTERLEAVED, 1, SAMPLE_RATE, 1, 1000))) {
printf("Got BS24C1\n");
sf_sampsize = SIZE_24;
} else if (!(code = snd_pcm_set_params(scope_pcm, SND_PCM_FORMAT_S32, SND_PCM_ACCESS_RW_INTERLEAVED, 1, SAMPLE_RATE, 1, 1000))) {
printf("Got BS32C1\n");
sf_sampsize = SIZE_32;
} else if (!(code = snd_pcm_set_params(scope_pcm, SND_PCM_FORMAT_U8, SND_PCM_ACCESS_RW_INTERLEAVED, 1, SAMPLE_RATE, 1, 1000))) {
printf("Got BU8C1\n");
sf_us = 1;
} else if (!(code = snd_pcm_set_params(scope_pcm, SND_PCM_FORMAT_U16, SND_PCM_ACCESS_RW_INTERLEAVED, 1, SAMPLE_RATE, 1, 1000))) {
printf("Got BU16C1\n");
sf_sampsize = SIZE_16;
sf_us = 1;
} else if (!(code = snd_pcm_set_params(scope_pcm, SND_PCM_FORMAT_U24, SND_PCM_ACCESS_RW_INTERLEAVED, 1, SAMPLE_RATE, 1, 1000))) {
printf("Got BU24C1\n");
sf_sampsize = SIZE_24;
sf_us = 1;
} else if (!(code = snd_pcm_set_params(scope_pcm, SND_PCM_FORMAT_U32, SND_PCM_ACCESS_RW_INTERLEAVED, 1, SAMPLE_RATE, 1, 1000))) {
printf("Got BU32C1\n");
sf_sampsize = SIZE_32;
sf_us = 1;
} else {
printf("Couldn't convince ALSA to give sane settings: %i\n", code);
snd_pcm_close(scope_pcm);
free(bufferC);
return 1;
}
}
sf_chancount = sf_usey ? 2 : 1;

int bytesPerSample = 1;
if (!(code = snd_pcm_set_params(scope_pcm, SND_PCM_FORMAT_S8, SND_PCM_ACCESS_RW_INTERLEAVED, sf_chancount, SAMPLE_RATE, 1, 1000))) {
sf_sampsize = SIZE_8;
} else if (!(code = snd_pcm_set_params(scope_pcm, SND_PCM_FORMAT_S16, SND_PCM_ACCESS_RW_INTERLEAVED, sf_chancount, SAMPLE_RATE, 1, 1000))) {
sf_sampsize = SIZE_16;
} else if (!(code = snd_pcm_set_params(scope_pcm, SND_PCM_FORMAT_S24, SND_PCM_ACCESS_RW_INTERLEAVED, sf_chancount, SAMPLE_RATE, 1, 1000))) {
sf_sampsize = SIZE_24;
} else if (!(code = snd_pcm_set_params(scope_pcm, SND_PCM_FORMAT_S32, SND_PCM_ACCESS_RW_INTERLEAVED, sf_chancount, SAMPLE_RATE, 1, 1000))) {
sf_sampsize = SIZE_32;
} else if (!(code = snd_pcm_set_params(scope_pcm, SND_PCM_FORMAT_U8, SND_PCM_ACCESS_RW_INTERLEAVED, sf_chancount, SAMPLE_RATE, 1, 1000))) {
sf_sampsize = SIZE_8;
sf_us = 1;
} else if (!(code = snd_pcm_set_params(scope_pcm, SND_PCM_FORMAT_U16, SND_PCM_ACCESS_RW_INTERLEAVED, sf_chancount, SAMPLE_RATE, 1, 1000))) {
sf_sampsize = SIZE_16;
sf_us = 1;
} else if (!(code = snd_pcm_set_params(scope_pcm, SND_PCM_FORMAT_U24, SND_PCM_ACCESS_RW_INTERLEAVED, sf_chancount, SAMPLE_RATE, 1, 1000))) {
sf_sampsize = SIZE_24;
sf_us = 1;
} else if (!(code = snd_pcm_set_params(scope_pcm, SND_PCM_FORMAT_U32, SND_PCM_ACCESS_RW_INTERLEAVED, sf_chancount, SAMPLE_RATE, 1, 1000))) {
sf_sampsize = SIZE_32;
sf_us = 1;
} else {
printf("Couldn't convince ALSA to give sane settings: %i\n", code);
snd_pcm_close(scope_pcm);
free(bufferC);
return 1;
}

int bytesPerSample;
int bitsPerSample;
switch (sf_sampsize) {
case SIZE_8:
bytesPerSample = 1;
bitsPerSample = 8;
break;
case SIZE_16:
bytesPerSample = 2;
bitsPerSample = 16;
break;
case SIZE_24:
bytesPerSample = 3;
bitsPerSample = 24;
break;
case SIZE_32:
bytesPerSample = 4;
bitsPerSample = 32;
break;
}

bufferA = malloc(BUFFER_FRAMES * (sf_2c ? 2 : 1) * bytesPerSample);
printf("Got B%c%dC%d\n", sf_us ? 'U' : 'S', bitsPerSample, sf_chancount);

bufferA = malloc(BUFFER_FRAMES * sf_chancount * bytesPerSample);
if (!bufferA) {
printf("Couldn't allocate working buffer\n");
snd_pcm_close(scope_pcm);
Expand Down

0 comments on commit 5ab3ebb

Please sign in to comment.