/* Encode and decode algorithms for Yamaha ADPCM-A 2019 by superctr. */ #include #include #include #include #include #define CLAMP(x, low, high) (((x) > (high)) ? (high) : (((x) < (low)) ? (low) : (x))) static const uint16_t yma_step_table[49] = { 16, 17, 19, 21, 23, 25, 28, 31, 34, 37, 41, 45, 50, 55, 60, 66, 73, 80, 88, 97, 107,118,130,143, 157,173,190,209,230,253,279,307, 337,371,408,449,494,544,598,658, 724,796,876,963,1060,1166,1282,1411,1552 }; // *** Yamaha ADPCM-A *** static inline int16_t yma_step(uint8_t step, int16_t* history, uint8_t* step_hist) { static const int8_t delta_table[16] = { 1,3,5,7,9,11,13,15, -1,-3,-5,-7,-9,-11,-13,-15 }; static const int8_t adjust_table[8] = { -1,-1,-1,-1,2,5,7,9 }; uint16_t step_size = yma_step_table[*step_hist]; int16_t delta = delta_table[step & 15] * step_size / 8; int16_t out = (*history + delta) & 0xfff; // No saturation out |= (out & 0x800) ? ~0xfff : 0; *history = out; int8_t adjusted_step = *step_hist + adjust_table[step & 7]; // Different adjust table *step_hist = CLAMP(adjusted_step, 0, 48); return out; } static inline uint8_t yma_encode_step(int16_t input, int16_t* history, uint8_t *step_hist) { int bit; uint16_t step_size = yma_step_table[*step_hist]; int16_t delta = input - *history; uint8_t adpcm_sample = (delta < 0) ? 8 : 0; if(delta < 0) adpcm_sample = 8; delta = abs(delta); for(bit=3; bit--; ) { if(delta >= step_size) { adpcm_sample |= (1<>= 1; } yma_step(adpcm_sample,history,step_hist); return adpcm_sample; } void yma_encode(int16_t *buffer,uint8_t *outbuffer,long len) { long i; int16_t history = 0; uint8_t step_hist = 0; uint8_t buf_sample = 0, nibble = 0; for(i=0;i>= 4; int step = yma_encode_step(sample, &history, &step_hist); if(nibble) *outbuffer++ = buf_sample | (step&15); else buf_sample = (step&15)<<4; nibble^=1; } } void yma_decode(uint8_t *buffer,int16_t *outbuffer,long len) { long i; int16_t history = 0; uint8_t step_hist = 0; uint8_t nibble = 0; for(i=0;i>= 4; if(nibble) buffer++; nibble^=4; *outbuffer++ = yma_step(step, &history, &step_hist) << 4; } }