|  | /* | 
|  | * Copyright (c) 2021, Alliance for Open Media. All rights reserved | 
|  | * | 
|  | * This source code is subject to the terms of the BSD 3-Clause Clear License | 
|  | * and the Alliance for Open Media Patent License 1.0. If the BSD 3-Clause Clear | 
|  | * License was not distributed with this source code in the LICENSE file, you | 
|  | * can obtain it at aomedia.org/license/software-license/bsd-3-c-c/.  If the | 
|  | * Alliance for Open Media Patent License 1.0 was not distributed with this | 
|  | * source code in the PATENTS file, you can obtain it at | 
|  | * aomedia.org/license/patent-license/. | 
|  | */ | 
|  |  | 
|  | #include <assert.h> | 
|  | #include <limits.h> | 
|  | #include <stdlib.h> | 
|  |  | 
|  | #include "config/aom_config.h" | 
|  |  | 
|  | #include "aom_dsp/bitwriter_buffer.h" | 
|  | #include "aom_dsp/recenter.h" | 
|  | #include "aom_ports/bitops.h" | 
|  |  | 
|  | int aom_wb_is_byte_aligned(const struct aom_write_bit_buffer *wb) { | 
|  | return (wb->bit_offset % CHAR_BIT == 0); | 
|  | } | 
|  |  | 
|  | uint32_t aom_wb_bytes_written(const struct aom_write_bit_buffer *wb) { | 
|  | return wb->bit_offset / CHAR_BIT + (wb->bit_offset % CHAR_BIT > 0); | 
|  | } | 
|  |  | 
|  | void aom_wb_write_bit(struct aom_write_bit_buffer *wb, int bit) { | 
|  | const int off = (int)wb->bit_offset; | 
|  | const int p = off / CHAR_BIT; | 
|  | const int q = CHAR_BIT - 1 - off % CHAR_BIT; | 
|  | if (q == CHAR_BIT - 1) { | 
|  | // Zero next char and write bit | 
|  | wb->bit_buffer[p] = bit << q; | 
|  | } else { | 
|  | wb->bit_buffer[p] &= ~(1 << q); | 
|  | wb->bit_buffer[p] |= bit << q; | 
|  | } | 
|  | wb->bit_offset = off + 1; | 
|  | } | 
|  |  | 
|  | void aom_wb_overwrite_bit(struct aom_write_bit_buffer *wb, int bit) { | 
|  | // Do not zero bytes but overwrite exisiting values | 
|  | const int off = (int)wb->bit_offset; | 
|  | const int p = off / CHAR_BIT; | 
|  | const int q = CHAR_BIT - 1 - off % CHAR_BIT; | 
|  | wb->bit_buffer[p] &= ~(1 << q); | 
|  | wb->bit_buffer[p] |= bit << q; | 
|  | wb->bit_offset = off + 1; | 
|  | } | 
|  |  | 
|  | void aom_wb_write_literal(struct aom_write_bit_buffer *wb, int data, int bits) { | 
|  | assert(bits <= 31); | 
|  | int bit; | 
|  | for (bit = bits - 1; bit >= 0; bit--) aom_wb_write_bit(wb, (data >> bit) & 1); | 
|  | } | 
|  |  | 
|  | void aom_wb_write_unsigned_literal(struct aom_write_bit_buffer *wb, | 
|  | uint32_t data, int bits) { | 
|  | assert(bits <= 32); | 
|  | int bit; | 
|  | for (bit = bits - 1; bit >= 0; bit--) aom_wb_write_bit(wb, (data >> bit) & 1); | 
|  | } | 
|  |  | 
|  | void aom_wb_overwrite_literal(struct aom_write_bit_buffer *wb, int data, | 
|  | int bits) { | 
|  | int bit; | 
|  | for (bit = bits - 1; bit >= 0; bit--) | 
|  | aom_wb_overwrite_bit(wb, (data >> bit) & 1); | 
|  | } | 
|  |  | 
|  | void aom_wb_write_inv_signed_literal(struct aom_write_bit_buffer *wb, int data, | 
|  | int bits) { | 
|  | aom_wb_write_literal(wb, data, bits + 1); | 
|  | } | 
|  |  | 
|  | void aom_wb_write_uvlc(struct aom_write_bit_buffer *wb, uint32_t v) { | 
|  | int64_t shift_val = ++v; | 
|  | int leading_zeroes = 1; | 
|  |  | 
|  | assert(shift_val > 0); | 
|  |  | 
|  | while (shift_val >>= 1) leading_zeroes += 2; | 
|  |  | 
|  | aom_wb_write_literal(wb, 0, leading_zeroes >> 1); | 
|  | aom_wb_write_unsigned_literal(wb, v, (leading_zeroes + 1) >> 1); | 
|  | } | 
|  |  | 
|  | void aom_wb_write_primitive_quniform(struct aom_write_bit_buffer *wb, | 
|  | uint16_t n, uint16_t v) { | 
|  | if (n <= 1) return; | 
|  | assert(v < n); | 
|  | // Split the valid range into two. | 
|  | // The encoded value is in the range [0, n), but in order to map a range | 
|  | // which may not be a power of 2 onto a binary code, we split into the | 
|  | // sub-ranges [0, m) and [m, n), where m is an intermediate point. | 
|  | // Values in the range [0, m) then use one fewer bit than values in | 
|  | // the range [m, n). | 
|  | const int l = get_msb(n) + 1; | 
|  | const int m = (1 << l) - n; | 
|  | if (v < m) { | 
|  | aom_wb_write_literal(wb, v, l - 1); | 
|  | } else { | 
|  | aom_wb_write_literal(wb, m + ((v - m) >> 1), l - 1); | 
|  | aom_wb_write_bit(wb, (v - m) & 1); | 
|  | } | 
|  | } | 
|  |  | 
|  | static void wb_write_primitive_subexpfin(struct aom_write_bit_buffer *wb, | 
|  | uint16_t n, uint16_t k, uint16_t v) { | 
|  | int i = 0; | 
|  | int mk = 0; | 
|  | while (1) { | 
|  | int b = (i ? k + i - 1 : k); | 
|  | int a = (1 << b); | 
|  | if (n <= mk + 3 * a) { | 
|  | aom_wb_write_primitive_quniform(wb, n - mk, v - mk); | 
|  | break; | 
|  | } else { | 
|  | int t = (v >= mk + a); | 
|  | aom_wb_write_bit(wb, t); | 
|  | if (t) { | 
|  | i = i + 1; | 
|  | mk += a; | 
|  | } else { | 
|  | aom_wb_write_literal(wb, v - mk, b); | 
|  | break; | 
|  | } | 
|  | } | 
|  | } | 
|  | } | 
|  |  | 
|  | static void wb_write_primitive_refsubexpfin(struct aom_write_bit_buffer *wb, | 
|  | uint16_t n, uint16_t k, | 
|  | uint16_t ref, uint16_t v) { | 
|  | assert(ref < n); | 
|  | assert(v < n); | 
|  | wb_write_primitive_subexpfin(wb, n, k, recenter_finite_nonneg(n, ref, v)); | 
|  | } | 
|  |  | 
|  | void aom_wb_write_signed_primitive_refsubexpfin(struct aom_write_bit_buffer *wb, | 
|  | uint16_t n, uint16_t k, | 
|  | int16_t ref, int16_t v) { | 
|  | assert(n > 0); | 
|  | const uint16_t offset = n - 1; | 
|  | const uint16_t scaled_n = (n << 1) - 1; | 
|  | wb_write_primitive_refsubexpfin(wb, scaled_n, k, ref + offset, v + offset); | 
|  | } |