SILK bugfix
[opus.git] / src / opus_encoder.c
index fa507d0..4ac580e 100644 (file)
    notice, this list of conditions and the following disclaimer in the
    documentation and/or other materials provided with the distribution.
 
-   - Neither the name of the Xiph.org Foundation nor the names of its
-   contributors may be used to endorse or promote products derived from
-   this software without specific prior written permission.
-
    THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
    ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
    LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
@@ -46,7 +42,6 @@ OpusEncoder *opus_encoder_create(int Fs, int channels)
     char *raw_state;
        OpusEncoder *st;
        int ret, silkEncSizeBytes, celtEncSizeBytes;
-    SKP_SILK_SDK_EncControlStruct encControl;
 
     /* Create SILK encoder */
     ret = SKP_Silk_SDK_Get_Encoder_Size( &silkEncSizeBytes );
@@ -58,99 +53,140 @@ OpusEncoder *opus_encoder_create(int Fs, int channels)
     st = (OpusEncoder*)raw_state;
     st->silk_enc = (void*)(raw_state+sizeof(OpusEncoder));
     st->celt_enc = (CELTEncoder*)(raw_state+sizeof(OpusEncoder)+silkEncSizeBytes);
-    st->channels = channels;
+    st->stream_channels = st->channels = channels;
 
     st->Fs = Fs;
 
-    /*encControl.API_sampleRate        = st->Fs;
-    encControl.packetLossPercentage  = 0;
-    encControl.useInBandFEC          = 0;
-    encControl.useDTX                = 0;
-    encControl.complexity            = 2;*/
-    ret = SKP_Silk_SDK_InitEncoder( st->silk_enc, &encControl );
+    ret = SKP_Silk_SDK_InitEncoder( st->silk_enc, &st->silk_mode );
     if( ret ) {
         /* Handle error */
     }
 
+    /* default SILK parameters */
+    st->silk_mode.API_sampleRate        = st->Fs;
+    st->silk_mode.maxInternalSampleRate = 16000;
+    st->silk_mode.minInternalSampleRate = 8000;
+    st->silk_mode.payloadSize_ms        = 20;
+    st->silk_mode.packetLossPercentage  = 0;
+    st->silk_mode.useInBandFEC          = 0;
+    st->silk_mode.useDTX                = 0;
+    st->silk_mode.complexity            = 10;
+
     /* Create CELT encoder */
        /* Initialize CELT encoder */
        st->celt_enc = celt_encoder_init(st->celt_enc, Fs, channels, NULL);
 
        st->mode = MODE_HYBRID;
        st->bandwidth = BANDWIDTH_FULLBAND;
-       st->vbr_rate = 0;
+       st->use_vbr = 0;
+       st->bitrate_bps = 32000;
 
        return st;
 }
 
 int opus_encode(OpusEncoder *st, const short *pcm, int frame_size,
-               unsigned char *data, int bytes_per_packet)
+               unsigned char *data, int max_data_bytes)
 {
     int i;
        int ret=0;
        SKP_int32 nBytes;
        ec_enc enc;
-       ec_byte_buffer buf;
-       SKP_SILK_SDK_EncControlStruct encControl;
        int framerate, period;
+    int silk_internal_bandwidth;
+    int bytes_target;
+    int prefill=0;
+    int start_band;
+    int redundancy = 0;
 
-       bytes_per_packet -= 1;
-       data += 1;
-       ec_byte_writeinit_buffer(&buf, data, bytes_per_packet);
-       ec_enc_init(&enc,&buf);
+       bytes_target = st->bitrate_bps * frame_size / (st->Fs * 8) - 1;
 
-       if (st->mode != MODE_CELT_ONLY)
+       data += 1;
+       if (st->mode != MODE_CELT_ONLY && st->prev_mode == MODE_CELT_ONLY)
        {
-           /* Set Encoder parameters */
-           encControl.API_sampleRate        = st->Fs;
-           encControl.packetLossPercentage  = 2;
-           encControl.useInBandFEC          = 0;
-           encControl.useDTX                = 0;
-           encControl.complexity            = 2;
-
-           if (st->vbr_rate != 0)
-            encControl.bitRate = (st->vbr_rate+6000)/2;
-           else {
-               encControl.bitRate = (bytes_per_packet*8*(celt_int32)st->Fs/frame_size+6000)/2;
-               if (st->Fs  == 100 * frame_size)
-                   encControl.bitRate -= 5000;
-           }
-           encControl.payloadSize_ms = 1000 * frame_size / st->Fs;
-
-           if (st->mode == MODE_HYBRID)
-               encControl.minInternalSampleRate = 16000;
-           else
-               encControl.minInternalSampleRate = 8000;
-
-           if (st->bandwidth == BANDWIDTH_NARROWBAND)
-               encControl.maxInternalSampleRate = 8000;
-           else if (st->bandwidth == BANDWIDTH_MEDIUMBAND)
-               encControl.maxInternalSampleRate = 12000;
-           else
-               encControl.maxInternalSampleRate = 16000;
-
-           /* Call SILK encoder for the low band */
-           nBytes = bytes_per_packet;
-           ret = SKP_Silk_SDK_Encode( st->silk_enc, &encControl, pcm, frame_size, &enc, &nBytes );
-           if( ret ) {
-               fprintf (stderr, "SILK encode error %d\n", ret);
-               /* Handle error */
-           }
-           ret = (ec_enc_tell(&enc, 0)+7)>>3;
+               SKP_SILK_SDK_EncControlStruct dummy;
+               SKP_Silk_SDK_InitEncoder( st->silk_enc, &dummy);
+               prefill=1;
        }
 
-       if (st->mode == MODE_HYBRID)
-       {
-           /* This should be adjusted based on the SILK bandwidth */
-           celt_encoder_ctl(st->celt_enc, CELT_SET_START_BAND(17));
-       } else {
-        celt_encoder_ctl(st->celt_enc, CELT_SET_START_BAND(0));
-       }
+       ec_enc_init(&enc, data, max_data_bytes-1);
+
+       /* SILK processing */
+    if (st->mode != MODE_CELT_ONLY)
+    {
+        st->silk_mode.bitRate = st->bitrate_bps - 8*st->Fs/frame_size;
+        if( st->mode == MODE_HYBRID ) {
+            if( st->bandwidth == BANDWIDTH_SUPERWIDEBAND ) {
+                if( st->Fs == 100 * frame_size ) {
+                    /* 24 kHz, 10 ms */
+                    st->silk_mode.bitRate = ( ( st->silk_mode.bitRate + 2000 + st->use_vbr * 1000 ) * 2 ) / 3;
+                } else {
+                    /* 24 kHz, 20 ms */
+                    st->silk_mode.bitRate = ( ( st->silk_mode.bitRate + 1000 + st->use_vbr * 1000 ) * 2 ) / 3;
+                }
+            } else {
+                if( st->Fs == 100 * frame_size ) {
+                    /* 48 kHz, 10 ms */
+                    st->silk_mode.bitRate = ( st->silk_mode.bitRate + 8000 + st->use_vbr * 3000 ) / 2;
+                } else {
+                    /* 48 kHz, 20 ms */
+                    st->silk_mode.bitRate = ( st->silk_mode.bitRate + 9000 + st->use_vbr * 1000 ) / 2;
+                }
+            }
+            /* don't let SILK use more than 80% */
+            if( st->silk_mode.bitRate > ( st->bitrate_bps - 8*st->Fs/frame_size ) * 4/5 ) {
+                st->silk_mode.bitRate = ( st->bitrate_bps - 8*st->Fs/frame_size ) * 4/5;
+            }
+        }
+
+        st->silk_mode.payloadSize_ms = 1000 * frame_size / st->Fs;
+        if (st->bandwidth == BANDWIDTH_NARROWBAND) {
+            st->silk_mode.maxInternalSampleRate = 8000;
+        } else if (st->bandwidth == BANDWIDTH_MEDIUMBAND) {
+            st->silk_mode.maxInternalSampleRate = 12000;
+        } else {
+            SKP_assert( st->mode == MODE_HYBRID || st->bandwidth == BANDWIDTH_WIDEBAND );
+            st->silk_mode.maxInternalSampleRate = 16000;
+        }
+        if( st->mode == MODE_HYBRID ) {
+            /* Don't allow bandwidth reduction at lowest bitrates in hybrid mode */
+            st->silk_mode.minInternalSampleRate = 16000;
+        } else {
+            st->silk_mode.minInternalSampleRate = 8000;
+        }
+
+        /* Call SILK encoder for the low band */
+        nBytes = max_data_bytes-1;
+        if (prefill)
+        {
+            int zero=0;
+               SKP_Silk_SDK_Encode( st->silk_enc, &st->silk_mode, st->delay_buffer, ENCODER_BUFFER, NULL, &zero, 1 );
+        }
+
+        ret = SKP_Silk_SDK_Encode( st->silk_enc, &st->silk_mode, pcm, frame_size, &enc, &nBytes, 0 );
+        if( ret ) {
+            fprintf (stderr, "SILK encode error: %d\n", ret);
+            /* Handle error */
+        }
+        /* Extract SILK internal bandwidth for signaling in first byte */
+        if( st->mode == MODE_SILK_ONLY ) {
+            if( st->silk_mode.internalSampleRate == 8000 ) {
+                silk_internal_bandwidth = BANDWIDTH_NARROWBAND;
+            } else if( st->silk_mode.internalSampleRate == 12000 ) {
+                silk_internal_bandwidth = BANDWIDTH_MEDIUMBAND;
+            } else if( st->silk_mode.internalSampleRate == 16000 ) {
+                silk_internal_bandwidth = BANDWIDTH_WIDEBAND;
+            }
+        } else {
+            SKP_assert( st->silk_mode.internalSampleRate == 16000 );
+        }
+    }
 
-       if (st->mode != MODE_SILK_ONLY && st->bandwidth > BANDWIDTH_WIDEBAND)
+    /* CELT processing */
+       if (st->mode != MODE_SILK_ONLY)
        {
-               int endband;
+           int endband;
            short pcm_buf[960*2];
+           int nb_compr_bytes;
 
            switch(st->bandwidth)
            {
@@ -168,27 +204,76 @@ int opus_encode(OpusEncoder *st, const short *pcm, int frame_size,
                break;
            }
            celt_encoder_ctl(st->celt_enc, CELT_SET_END_BAND(endband));
+           celt_encoder_ctl(st->celt_enc, CELT_SET_CHANNELS(st->stream_channels));
 
-           for (i=0;i<ENCODER_DELAY_COMPENSATION*st->channels;i++)
-               pcm_buf[i] = st->delay_buffer[i];
-        for (;i<frame_size*st->channels;i++)
-            pcm_buf[i] = pcm[i-ENCODER_DELAY_COMPENSATION*st->channels];
+        celt_encoder_ctl(st->celt_enc, CELT_SET_VBR(0));
+        celt_encoder_ctl(st->celt_enc, CELT_SET_BITRATE(510000));
+        if (st->prev_mode == MODE_SILK_ONLY)
+        {
+               unsigned char dummy[2];
+               celt_encoder_ctl(st->celt_enc, CELT_RESET_STATE);
+               celt_encoder_ctl(st->celt_enc, CELT_SET_PREDICTION(0));
+               /* FIXME: This wastes CPU a bit compared to just prefilling the buffer */
+               celt_encode(st->celt_enc, &st->delay_buffer[(ENCODER_BUFFER-ENCODER_DELAY_COMPENSATION-120)*st->channels], 120, dummy, 10);
+        } else {
+               celt_encoder_ctl(st->celt_enc, CELT_SET_PREDICTION(2));
+        }
 
-        celt_encoder_ctl(st->celt_enc, CELT_SET_PREDICTION(1));
+        start_band = 0;
+        if (st->mode == MODE_HYBRID)
+        {
+            /* Check if we have a redundant 0-8 kHz band */
+            ec_enc_bit_logp(&enc, redundancy, 12);
+            if (!redundancy)
+                start_band = 17;
+        }
+        celt_encoder_ctl(st->celt_enc, CELT_SET_START_BAND(start_band));
 
-        if (st->vbr_rate != 0)
+        if (st->mode == MODE_HYBRID)
         {
-            int tmp = (st->vbr_rate-6000)/2;
-            tmp = ((ec_enc_tell(&enc, 0)+4)>>3) + tmp * frame_size/(8*st->Fs);
-            if (tmp <= bytes_per_packet)
-                bytes_per_packet = tmp;
-            ec_byte_shrink(&buf, bytes_per_packet);
+            int len;
+
+            len = (ec_tell(&enc)+7)>>3;
+            if( st->use_vbr ) {
+                nb_compr_bytes = len + bytes_target - (st->silk_mode.bitRate * frame_size) / (8 * st->Fs);
+            } else {
+                /* check if SILK used up too much */
+                nb_compr_bytes = len > bytes_target ? len : bytes_target;
+            }
+        } else {
+            if (st->use_vbr)
+            {
+                celt_encoder_ctl(st->celt_enc, CELT_SET_VBR(1));
+                celt_encoder_ctl(st->celt_enc, CELT_SET_BITRATE(st->bitrate_bps));
+                nb_compr_bytes = max_data_bytes-1;
+            } else {
+                nb_compr_bytes = bytes_target;
+            }
         }
+
+        for (i=0;i<IMIN(frame_size, ENCODER_DELAY_COMPENSATION)*st->channels;i++)
+            pcm_buf[i] = st->delay_buffer[(ENCODER_BUFFER-ENCODER_DELAY_COMPENSATION)*st->channels+i];
+        for (;i<frame_size*st->channels;i++)
+            pcm_buf[i] = pcm[i-ENCODER_DELAY_COMPENSATION*st->channels];
+
+        ec_enc_shrink(&enc, nb_compr_bytes);
+
            /* Encode high band with CELT */
-           ret = celt_encode_with_ec(st->celt_enc, pcm_buf, frame_size, NULL, bytes_per_packet, &enc);
-           for (i=0;i<ENCODER_DELAY_COMPENSATION*st->channels;i++)
-               st->delay_buffer[i] = pcm[frame_size*st->channels-ENCODER_DELAY_COMPENSATION*st->channels+i];
+           ret = celt_encode_with_ec(st->celt_enc, pcm_buf, frame_size, NULL, nb_compr_bytes, &enc);
+
+           if (frame_size>ENCODER_BUFFER)
+           {
+               for (i=0;i<ENCODER_BUFFER*st->channels;i++)
+                   st->delay_buffer[i] = pcm[(frame_size-ENCODER_BUFFER)*st->channels+i];
+           } else {
+               int tmp = ENCODER_BUFFER-frame_size;
+               for (i=0;i<tmp*st->channels;i++)
+                   st->delay_buffer[i] = st->delay_buffer[i+frame_size*st->channels];
+               for (i=0;i<frame_size*st->channels;i++)
+                   st->delay_buffer[tmp*st->channels+i] = pcm[i];
+           }
        } else {
+           ret = (ec_tell(&enc)+7)>>3;
            ec_enc_done(&enc);
        }
 
@@ -203,7 +288,7 @@ int opus_encode(OpusEncoder *st, const short *pcm, int frame_size,
        }
     if (st->mode == MODE_SILK_ONLY)
     {
-        data[0] = (st->bandwidth-BANDWIDTH_NARROWBAND)<<5;
+        data[0] = (silk_internal_bandwidth-BANDWIDTH_NARROWBAND)<<5;
         data[0] |= (period-2)<<3;
     } else if (st->mode == MODE_CELT_ONLY)
     {
@@ -213,14 +298,19 @@ int opus_encode(OpusEncoder *st, const short *pcm, int frame_size,
         data[0] = 0x80;
         data[0] |= tmp << 5;
         data[0] |= period<<3;
-    } else /* Opus */
+    } else /* Hybrid */
     {
         data[0] = 0x60;
         data[0] |= (st->bandwidth-BANDWIDTH_SUPERWIDEBAND)<<4;
         data[0] |= (period-2)<<3;
     }
+    data[0] |= (st->stream_channels==2)<<2;
     /*printf ("%x\n", (int)data[0]);*/
 
+#if OPUS_TEST_RANGE_CODER_STATE
+    st->rangeFinal = enc.rng;
+#endif
+    st->prev_mode = st->mode;
     return ret+1;
 }
 
@@ -244,10 +334,29 @@ void opus_encoder_ctl(OpusEncoder *st, int request, ...)
             *value = st->mode;
         }
         break;
+        case OPUS_SET_BITRATE_REQUEST:
+        {
+            int value = va_arg(ap, int);
+            st->bitrate_bps = value;
+        }
+        break;
+        case OPUS_GET_BITRATE_REQUEST:
+        {
+            int *value = va_arg(ap, int*);
+            *value = st->bitrate_bps;
+        }
+        break;
         case OPUS_SET_BANDWIDTH_REQUEST:
         {
             int value = va_arg(ap, int);
             st->bandwidth = value;
+            if (st->bandwidth == BANDWIDTH_NARROWBAND) {
+                st->silk_mode.maxInternalSampleRate = 8000;
+            } else if (st->bandwidth == BANDWIDTH_MEDIUMBAND) {
+                st->silk_mode.maxInternalSampleRate = 12000;
+            } else {
+                st->silk_mode.maxInternalSampleRate = 16000;
+            }
         }
         break;
         case OPUS_GET_BANDWIDTH_REQUEST:
@@ -256,16 +365,66 @@ void opus_encoder_ctl(OpusEncoder *st, int request, ...)
             *value = st->bandwidth;
         }
         break;
-        case OPUS_SET_VBR_RATE_REQUEST:
+        case OPUS_SET_DTX_FLAG_REQUEST:
+        {
+            int value = va_arg(ap, int);
+            st->silk_mode.useDTX = value;
+        }
+        break;
+        case OPUS_GET_DTX_FLAG_REQUEST:
+        {
+            int *value = va_arg(ap, int*);
+            *value = st->silk_mode.useDTX;
+        }
+        break;
+        case OPUS_SET_COMPLEXITY_REQUEST:
+        {
+            int value = va_arg(ap, int);
+            st->silk_mode.complexity = value;
+            celt_encoder_ctl(st->celt_enc, CELT_SET_COMPLEXITY(value));
+        }
+        break;
+        case OPUS_GET_COMPLEXITY_REQUEST:
+        {
+            int *value = va_arg(ap, int*);
+            *value = st->silk_mode.complexity;
+        }
+        break;
+        case OPUS_SET_INBAND_FEC_FLAG_REQUEST:
+        {
+            int value = va_arg(ap, int);
+            st->silk_mode.useInBandFEC = value;
+        }
+        break;
+        case OPUS_GET_INBAND_FEC_FLAG_REQUEST:
+        {
+            int *value = va_arg(ap, int*);
+            *value = st->silk_mode.useInBandFEC;
+        }
+        break;
+        case OPUS_SET_PACKET_LOSS_PERC_REQUEST:
+        {
+            int value = va_arg(ap, int);
+            st->silk_mode.packetLossPercentage = value;
+        }
+        break;
+        case OPUS_GET_PACKET_LOSS_PERC_REQUEST:
+        {
+            int *value = va_arg(ap, int*);
+            *value = st->silk_mode.packetLossPercentage;
+        }
+        break;
+        case OPUS_SET_VBR_FLAG_REQUEST:
         {
             int value = va_arg(ap, int);
-            st->vbr_rate = value;
+            st->use_vbr = value;
+            st->silk_mode.useCBR = 1-value;
         }
         break;
-        case OPUS_GET_VBR_RATE_REQUEST:
+        case OPUS_GET_VBR_FLAG_REQUEST:
         {
             int *value = va_arg(ap, int*);
-            *value = st->vbr_rate;
+            *value = st->use_vbr;
         }
         break;
         default:
@@ -281,3 +440,9 @@ void opus_encoder_destroy(OpusEncoder *st)
        free(st);
 }
 
+#if OPUS_TEST_RANGE_CODER_STATE
+int opus_encoder_get_final_range(OpusEncoder *st)
+{
+    return st->rangeFinal;
+}
+#endif