Parent Directory
| 
Revision Log
Revision 769 - (view) (download)
| 1 : | Isibaar | 616 | // 30.10.2002 corrected qpel chroma rounding |
| 2 : | Isibaar | 581 | // 04.10.2002 added qpel support to MBMotionCompensation |
| 3 : | edgomez | 195 | // 01.05.2002 updated MBMotionCompensationBVOP |
| 4 : | // 14.04.2002 bframe compensation | ||
| 5 : | suxen_drol | 118 | |
| 6 : | chl | 769 | #include <stdio.h> |
| 7 : | |||
| 8 : | Isibaar | 3 | #include "../encoder.h" |
| 9 : | #include "../utils/mbfunctions.h" | ||
| 10 : | #include "../image/interpolate8x8.h" | ||
| 11 : | suxen_drol | 701 | #include "../image/reduced.h" |
| 12 : | Isibaar | 3 | #include "../utils/timer.h" |
| 13 : | suxen_drol | 118 | #include "motion.h" |
| 14 : | Isibaar | 3 | |
| 15 : | chl | 769 | #ifndef ABS |
| 16 : | #define ABS(X) (((X)>0)?(X):-(X)) | ||
| 17 : | #endif | ||
| 18 : | #ifndef SIGN | ||
| 19 : | #define SIGN(X) (((X)>0)?1:-1) | ||
| 20 : | #endif | ||
| 21 : | |||
| 22 : | |||
| 23 : | /* This is borrowed from decoder.c */ | ||
| 24 : | static __inline int gmc_sanitize(int value, int quarterpel, int fcode) | ||
| 25 : | { | ||
| 26 : | int length = 1 << (fcode+4); | ||
| 27 : | |||
| 28 : | if (quarterpel) value *= 2; | ||
| 29 : | |||
| 30 : | if (value < -length) | ||
| 31 : | return -length; | ||
| 32 : | else if (value >= length) | ||
| 33 : | return length-1; | ||
| 34 : | else return value; | ||
| 35 : | } | ||
| 36 : | |||
| 37 : | /* And this is borrowed from bitstream.c until we find a common solution */ | ||
| 38 : | |||
| 39 : | static uint32_t __inline | ||
| 40 : | log2bin(uint32_t value) | ||
| 41 : | { | ||
| 42 : | /* Changed by Chenm001 */ | ||
| 43 : | #if !defined(_MSC_VER) | ||
| 44 : | int n = 0; | ||
| 45 : | |||
| 46 : | while (value) { | ||
| 47 : | value >>= 1; | ||
| 48 : | n++; | ||
| 49 : | } | ||
| 50 : | return n; | ||
| 51 : | #else | ||
| 52 : | __asm { | ||
| 53 : | bsr eax, value | ||
| 54 : | inc eax | ||
| 55 : | } | ||
| 56 : | #endif | ||
| 57 : | } | ||
| 58 : | |||
| 59 : | |||
| 60 : | edgomez | 195 | static __inline void |
| 61 : | Isibaar | 588 | compensate16x16_interpolate(int16_t * const dct_codes, |
| 62 : | syskin | 756 | uint8_t * const cur, |
| 63 : | const uint8_t * const ref, | ||
| 64 : | const uint8_t * const refh, | ||
| 65 : | const uint8_t * const refv, | ||
| 66 : | const uint8_t * const refhv, | ||
| 67 : | uint8_t * const tmp, | ||
| 68 : | uint32_t x, | ||
| 69 : | uint32_t y, | ||
| 70 : | const int32_t dx, | ||
| 71 : | const int32_t dy, | ||
| 72 : | chl | 769 | const int32_t stride, |
| 73 : | syskin | 756 | const int quarterpel, |
| 74 : | suxen_drol | 701 | const int reduced_resolution, |
| 75 : | chl | 769 | const int32_t rounding) |
| 76 : | Isibaar | 588 | { |
| 77 : | syskin | 756 | const uint8_t * ptr; |
| 78 : | Isibaar | 588 | |
| 79 : | syskin | 756 | if (!reduced_resolution) { |
| 80 : | Isibaar | 588 | |
| 81 : | suxen_drol | 701 | if(quarterpel) { |
| 82 : | chl | 769 | if ((dx&3) | (dy&3)) { |
| 83 : | syskin | 756 | interpolate16x16_quarterpel(tmp - y * stride - x, |
| 84 : | (uint8_t *) ref, tmp + 32, | ||
| 85 : | tmp + 64, tmp + 96, x, y, dx, dy, stride, rounding); | ||
| 86 : | ptr = tmp; | ||
| 87 : | syskin | 744 | } else ptr = ref + (y + dy/4)*stride + x + dx/4; // fullpixel position |
| 88 : | suxen_drol | 701 | |
| 89 : | syskin | 756 | } else ptr = get_ref(ref, refh, refv, refhv, x, y, 1, dx, dy, stride); |
| 90 : | |||
| 91 : | transfer_8to16sub(dct_codes, cur + y * stride + x, | ||
| 92 : | syskin | 744 | ptr, stride); |
| 93 : | syskin | 756 | transfer_8to16sub(dct_codes+64, cur + y * stride + x + 8, |
| 94 : | syskin | 744 | ptr + 8, stride); |
| 95 : | syskin | 756 | transfer_8to16sub(dct_codes+128, cur + y * stride + x + 8*stride, |
| 96 : | syskin | 744 | ptr + 8*stride, stride); |
| 97 : | syskin | 756 | transfer_8to16sub(dct_codes+192, cur + y * stride + x + 8*stride+8, |
| 98 : | ptr + 8*stride + 8, stride); | ||
| 99 : | suxen_drol | 701 | |
| 100 : | syskin | 756 | } else { //reduced_resolution |
| 101 : | |||
| 102 : | x *= 2; y *= 2; | ||
| 103 : | suxen_drol | 701 | |
| 104 : | syskin | 756 | ptr = get_ref(ref, refh, refv, refhv, x, y, 1, dx, dy, stride); |
| 105 : | |||
| 106 : | filter_18x18_to_8x8(dct_codes, cur+y*stride + x, stride); | ||
| 107 : | filter_diff_18x18_to_8x8(dct_codes, ptr, stride); | ||
| 108 : | |||
| 109 : | filter_18x18_to_8x8(dct_codes+64, cur+y*stride + x + 16, stride); | ||
| 110 : | filter_diff_18x18_to_8x8(dct_codes+64, ptr + 16, stride); | ||
| 111 : | |||
| 112 : | filter_18x18_to_8x8(dct_codes+128, cur+(y+16)*stride + x, stride); | ||
| 113 : | filter_diff_18x18_to_8x8(dct_codes+128, ptr + 16*stride, stride); | ||
| 114 : | |||
| 115 : | filter_18x18_to_8x8(dct_codes+192, cur+(y+16)*stride + x + 16, stride); | ||
| 116 : | filter_diff_18x18_to_8x8(dct_codes+192, ptr + 16*stride + 16, stride); | ||
| 117 : | |||
| 118 : | transfer32x32_copy(cur + y*stride + x, ptr, stride); | ||
| 119 : | Isibaar | 588 | } |
| 120 : | } | ||
| 121 : | |||
| 122 : | static __inline void | ||
| 123 : | syskin | 756 | compensate8x8_interpolate( int16_t * const dct_codes, |
| 124 : | uint8_t * const cur, | ||
| 125 : | const uint8_t * const ref, | ||
| 126 : | const uint8_t * const refh, | ||
| 127 : | const uint8_t * const refv, | ||
| 128 : | const uint8_t * const refhv, | ||
| 129 : | uint8_t * const tmp, | ||
| 130 : | uint32_t x, | ||
| 131 : | uint32_t y, | ||
| 132 : | const int32_t dx, | ||
| 133 : | const int32_t dy, | ||
| 134 : | chl | 769 | const int32_t stride, |
| 135 : | const int32_t quarterpel, | ||
| 136 : | syskin | 756 | const int reduced_resolution, |
| 137 : | chl | 769 | const int32_t rounding) |
| 138 : | Isibaar | 3 | { |
| 139 : | syskin | 756 | const uint8_t * ptr; |
| 140 : | suxen_drol | 702 | |
| 141 : | syskin | 756 | if (!reduced_resolution) { |
| 142 : | suxen_drol | 702 | |
| 143 : | suxen_drol | 701 | if(quarterpel) { |
| 144 : | chl | 769 | if ((dx&3) | (dy&3)) { |
| 145 : | syskin | 756 | interpolate8x8_quarterpel(tmp - y*stride - x, |
| 146 : | (uint8_t *) ref, tmp + 32, | ||
| 147 : | tmp + 64, tmp + 96, x, y, dx, dy, stride, rounding); | ||
| 148 : | ptr = tmp; | ||
| 149 : | } else ptr = ref + (y + dy/4)*stride + x + dx/4; // fullpixel position | ||
| 150 : | } else ptr = get_ref(ref, refh, refv, refhv, x, y, 1, dx, dy, stride); | ||
| 151 : | Isibaar | 581 | |
| 152 : | syskin | 756 | transfer_8to16sub(dct_codes, cur + y * stride + x, ptr, stride); |
| 153 : | syskin | 744 | |
| 154 : | syskin | 756 | } else { //reduced_resolution |
| 155 : | suxen_drol | 701 | |
| 156 : | syskin | 756 | x *= 2; y *= 2; |
| 157 : | |||
| 158 : | ptr = get_ref(ref, refh, refv, refhv, x, y, 1, dx, dy, stride); | ||
| 159 : | |||
| 160 : | filter_18x18_to_8x8(dct_codes, cur+y*stride + x, stride); | ||
| 161 : | filter_diff_18x18_to_8x8(dct_codes, ptr, stride); | ||
| 162 : | |||
| 163 : | transfer16x16_copy(cur + y*stride + x, ptr, stride); | ||
| 164 : | edgomez | 195 | } |
| 165 : | Isibaar | 3 | } |
| 166 : | |||
| 167 : | suxen_drol | 703 | /* XXX: slow, inelegant... */ |
| 168 : | static void | ||
| 169 : | interpolate18x18_switch(uint8_t * const cur, | ||
| 170 : | syskin | 756 | const uint8_t * const refn, |
| 171 : | const uint32_t x, | ||
| 172 : | const uint32_t y, | ||
| 173 : | const int32_t dx, | ||
| 174 : | const int dy, | ||
| 175 : | chl | 769 | const int32_t stride, |
| 176 : | const int32_t rounding) | ||
| 177 : | suxen_drol | 703 | { |
| 178 : | interpolate8x8_switch(cur, refn, x-1, y-1, dx, dy, stride, rounding); | ||
| 179 : | interpolate8x8_switch(cur, refn, x+7, y-1, dx, dy, stride, rounding); | ||
| 180 : | interpolate8x8_switch(cur, refn, x+9, y-1, dx, dy, stride, rounding); | ||
| 181 : | |||
| 182 : | interpolate8x8_switch(cur, refn, x-1, y+7, dx, dy, stride, rounding); | ||
| 183 : | interpolate8x8_switch(cur, refn, x+7, y+7, dx, dy, stride, rounding); | ||
| 184 : | interpolate8x8_switch(cur, refn, x+9, y+7, dx, dy, stride, rounding); | ||
| 185 : | |||
| 186 : | interpolate8x8_switch(cur, refn, x-1, y+9, dx, dy, stride, rounding); | ||
| 187 : | interpolate8x8_switch(cur, refn, x+7, y+9, dx, dy, stride, rounding); | ||
| 188 : | interpolate8x8_switch(cur, refn, x+9, y+9, dx, dy, stride, rounding); | ||
| 189 : | } | ||
| 190 : | |||
| 191 : | syskin | 756 | static void |
| 192 : | CompensateChroma( int dx, int dy, | ||
| 193 : | const int i, const int j, | ||
| 194 : | IMAGE * const Cur, | ||
| 195 : | const IMAGE * const Ref, | ||
| 196 : | uint8_t * const temp, | ||
| 197 : | int16_t * const coeff, | ||
| 198 : | chl | 769 | const int32_t stride, |
| 199 : | syskin | 756 | const int rounding, |
| 200 : | const int rrv) | ||
| 201 : | { /* uv-block-based compensation */ | ||
| 202 : | suxen_drol | 703 | |
| 203 : | syskin | 756 | if (!rrv) { |
| 204 : | transfer_8to16sub(coeff, Cur->u + 8 * j * stride + 8 * i, | ||
| 205 : | interpolate8x8_switch2(temp, Ref->u, 8 * i, 8 * j, | ||
| 206 : | dx, dy, stride, rounding), | ||
| 207 : | stride); | ||
| 208 : | transfer_8to16sub(coeff + 64, Cur->v + 8 * j * stride + 8 * i, | ||
| 209 : | interpolate8x8_switch2(temp, Ref->v, 8 * i, 8 * j, | ||
| 210 : | dx, dy, stride, rounding), | ||
| 211 : | stride); | ||
| 212 : | } else { | ||
| 213 : | uint8_t * current, * reference; | ||
| 214 : | |||
| 215 : | current = Cur->u + 16*j*stride + 16*i; | ||
| 216 : | reference = temp - 16*j*stride - 16*i; | ||
| 217 : | interpolate18x18_switch(reference, Ref->u, 16*i, 16*j, dx, dy, stride, rounding); | ||
| 218 : | filter_18x18_to_8x8(coeff, current, stride); | ||
| 219 : | filter_diff_18x18_to_8x8(coeff, temp, stride); | ||
| 220 : | transfer16x16_copy(current, temp, stride); | ||
| 221 : | |||
| 222 : | current = Cur->v + 16*j*stride + 16*i; | ||
| 223 : | interpolate18x18_switch(reference, Ref->v, 16*i, 16*j, dx, dy, stride, rounding); | ||
| 224 : | filter_18x18_to_8x8(coeff + 64, current, stride); | ||
| 225 : | filter_diff_18x18_to_8x8(coeff + 64, temp, stride); | ||
| 226 : | transfer16x16_copy(current, temp, stride); | ||
| 227 : | } | ||
| 228 : | } | ||
| 229 : | |||
| 230 : | edgomez | 195 | void |
| 231 : | MBMotionCompensation(MACROBLOCK * const mb, | ||
| 232 : | chl | 769 | const uint32_t i, |
| 233 : | const uint32_t j, | ||
| 234 : | const IMAGE * const ref, | ||
| 235 : | const IMAGE * const refh, | ||
| 236 : | const IMAGE * const refv, | ||
| 237 : | const IMAGE * const refhv, | ||
| 238 : | const IMAGE * const refGMC, | ||
| 239 : | IMAGE * const cur, | ||
| 240 : | int16_t * dct_codes, | ||
| 241 : | const uint32_t width, | ||
| 242 : | const uint32_t height, | ||
| 243 : | const uint32_t edged_width, | ||
| 244 : | const int32_t quarterpel, | ||
| 245 : | const int reduced_resolution, | ||
| 246 : | const int32_t rounding) | ||
| 247 : | Isibaar | 3 | { |
| 248 : | chl | 769 | int32_t dx; |
| 249 : | int32_t dy; | ||
| 250 : | |||
| 251 : | |||
| 252 : | syskin | 756 | uint8_t * const tmp = refv->u; |
| 253 : | suxen_drol | 701 | |
| 254 : | chl | 769 | if ( (!reduced_resolution) && (mb->mode == MODE_NOT_CODED) ) { /* quick copy for early SKIP */ |
| 255 : | /* early SKIP is only activated in P-VOPs, not in S-VOPs, so mcsel can never be 1 */ | ||
| 256 : | |||
| 257 : | /* if (mb->mcsel) { | ||
| 258 : | transfer16x16_copy(cur->y + 16 * (i + j * edged_width), | ||
| 259 : | refGMC->y + 16 * (i + j * edged_width), | ||
| 260 : | edged_width); | ||
| 261 : | transfer8x8_copy(cur->u + 8 * (i + j * edged_width/2), | ||
| 262 : | refGMC->u + 8 * (i + j * edged_width/2), | ||
| 263 : | edged_width / 2); | ||
| 264 : | transfer8x8_copy(cur->v + 8 * (i + j * edged_width/2), | ||
| 265 : | refGMC->v + 8 * (i + j * edged_width/2), | ||
| 266 : | edged_width / 2); | ||
| 267 : | } else | ||
| 268 : | */ | ||
| 269 : | { | ||
| 270 : | transfer16x16_copy(cur->y + 16 * (i + j * edged_width), | ||
| 271 : | syskin | 744 | ref->y + 16 * (i + j * edged_width), |
| 272 : | edged_width); | ||
| 273 : | |||
| 274 : | chl | 769 | transfer8x8_copy(cur->u + 8 * (i + j * edged_width/2), |
| 275 : | syskin | 744 | ref->u + 8 * (i + j * edged_width/2), |
| 276 : | edged_width / 2); | ||
| 277 : | chl | 769 | transfer8x8_copy(cur->v + 8 * (i + j * edged_width/2), |
| 278 : | syskin | 744 | ref->v + 8 * (i + j * edged_width/2), |
| 279 : | edged_width / 2); | ||
| 280 : | chl | 769 | } |
| 281 : | syskin | 744 | return; |
| 282 : | } | ||
| 283 : | Isibaar | 3 | |
| 284 : | chl | 769 | if ((mb->mode == MODE_NOT_CODED || mb->mode == MODE_INTER |
| 285 : | || mb->mode == MODE_INTER_Q) /*&& !quarterpel*/) { | ||
| 286 : | chl | 530 | |
| 287 : | chl | 769 | /* reduced resolution + GMC: not possible */ |
| 288 : | Isibaar | 581 | |
| 289 : | chl | 769 | if (mb->mcsel) { |
| 290 : | |||
| 291 : | /* call normal routine once, easier than "if (mcsel)"ing all the time */ | ||
| 292 : | |||
| 293 : | transfer_8to16sub(&dct_codes[0*64], cur->y + 16*j*edged_width + 16*i, | ||
| 294 : | refGMC->y + 16*j*edged_width + 16*i, edged_width); | ||
| 295 : | transfer_8to16sub(&dct_codes[1*64], cur->y + 16*j*edged_width + 16*i+8, | ||
| 296 : | refGMC->y + 16*j*edged_width + 16*i+8, edged_width); | ||
| 297 : | transfer_8to16sub(&dct_codes[2*64], cur->y + (16*j+8)*edged_width + 16*i, | ||
| 298 : | refGMC->y + (16*j+8)*edged_width + 16*i, edged_width); | ||
| 299 : | transfer_8to16sub(&dct_codes[3*64], cur->y + (16*j+8)*edged_width + 16*i+8, | ||
| 300 : | refGMC->y + (16*j+8)*edged_width + 16*i+8, edged_width); | ||
| 301 : | |||
| 302 : | /* lumi is needed earlier for mode decision, but chroma should be done block-based, but it isn't, yet. */ | ||
| 303 : | |||
| 304 : | transfer_8to16sub(&dct_codes[4 * 64], cur->u + 8 *j*edged_width/2 + 8*i, | ||
| 305 : | refGMC->u + 8 *j*edged_width/2 + 8*i, edged_width/2); | ||
| 306 : | |||
| 307 : | transfer_8to16sub(&dct_codes[5 * 64], cur->v + 8*j* edged_width/2 + 8*i, | ||
| 308 : | refGMC->v + 8*j* edged_width/2 + 8*i, edged_width/2); | ||
| 309 : | |||
| 310 : | return; | ||
| 311 : | } | ||
| 312 : | |||
| 313 : | /* ordinary compensation */ | ||
| 314 : | |||
| 315 : | dx = (quarterpel ? mb->qmvs[0].x : mb->mvs[0].x); | ||
| 316 : | dy = (quarterpel ? mb->qmvs[0].y : mb->mvs[0].y); | ||
| 317 : | |||
| 318 : | syskin | 744 | if (reduced_resolution) { |
| 319 : | suxen_drol | 702 | dx = RRV_MV_SCALEUP(dx); |
| 320 : | dy = RRV_MV_SCALEUP(dy); | ||
| 321 : | } | ||
| 322 : | |||
| 323 : | Isibaar | 588 | compensate16x16_interpolate(&dct_codes[0 * 64], cur->y, ref->y, refh->y, |
| 324 : | syskin | 756 | refv->y, refhv->y, tmp, 16 * i, 16 * j, dx, dy, |
| 325 : | edged_width, quarterpel, reduced_resolution, rounding); | ||
| 326 : | chl | 769 | |
| 327 : | dx /= (int)(1 + quarterpel); | ||
| 328 : | dy /= (int)(1 + quarterpel); | ||
| 329 : | |||
| 330 : | Isibaar | 617 | dx = (dx >> 1) + roundtab_79[dx & 0x3]; |
| 331 : | dy = (dy >> 1) + roundtab_79[dy & 0x3]; | ||
| 332 : | |||
| 333 : | chl | 530 | } else { // mode == MODE_INTER4V |
| 334 : | syskin | 756 | int k, sumx = 0, sumy = 0; |
| 335 : | const VECTOR * const mvs = (quarterpel ? mb->qmvs : mb->mvs); | ||
| 336 : | Isibaar | 3 | |
| 337 : | syskin | 756 | for (k = 0; k < 4; k++) { |
| 338 : | dx = mvs[k].x; | ||
| 339 : | dy = mvs[k].y; | ||
| 340 : | sumx += dx / (1 + quarterpel); | ||
| 341 : | sumy += dy / (1 + quarterpel); | ||
| 342 : | Isibaar | 581 | |
| 343 : | syskin | 756 | if (reduced_resolution){ |
| 344 : | dx = RRV_MV_SCALEUP(dx); | ||
| 345 : | dy = RRV_MV_SCALEUP(dy); | ||
| 346 : | suxen_drol | 702 | } |
| 347 : | Isibaar | 3 | |
| 348 : | syskin | 756 | compensate8x8_interpolate(&dct_codes[k * 64], cur->y, ref->y, refh->y, |
| 349 : | refv->y, refhv->y, tmp, 16 * i + 8*(k&1), 16 * j + 8*(k>>1), dx, | ||
| 350 : | dy, edged_width, quarterpel, reduced_resolution, rounding); | ||
| 351 : | syskin | 744 | } |
| 352 : | syskin | 756 | dx = (sumx >> 3) + roundtab_76[sumx & 0xf]; |
| 353 : | dy = (sumy >> 3) + roundtab_76[sumy & 0xf]; | ||
| 354 : | } | ||
| 355 : | Isibaar | 581 | |
| 356 : | syskin | 756 | CompensateChroma(dx, dy, i, j, cur, ref, tmp, |
| 357 : | &dct_codes[4 * 64], edged_width / 2, rounding, reduced_resolution); | ||
| 358 : | Isibaar | 3 | } |
| 359 : | suxen_drol | 118 | |
| 360 : | |||
| 361 : | edgomez | 195 | void |
| 362 : | MBMotionCompensationBVOP(MBParam * pParam, | ||
| 363 : | syskin | 756 | MACROBLOCK * const mb, |
| 364 : | const uint32_t i, | ||
| 365 : | const uint32_t j, | ||
| 366 : | IMAGE * const cur, | ||
| 367 : | const IMAGE * const f_ref, | ||
| 368 : | const IMAGE * const f_refh, | ||
| 369 : | const IMAGE * const f_refv, | ||
| 370 : | const IMAGE * const f_refhv, | ||
| 371 : | const IMAGE * const b_ref, | ||
| 372 : | const IMAGE * const b_refh, | ||
| 373 : | const IMAGE * const b_refv, | ||
| 374 : | const IMAGE * const b_refhv, | ||
| 375 : | int16_t * dct_codes) | ||
| 376 : | suxen_drol | 118 | { |
| 377 : | syskin | 756 | const uint32_t edged_width = pParam->edged_width; |
| 378 : | int32_t dx, dy, b_dx, b_dy, sumx, sumy, b_sumx, b_sumy; | ||
| 379 : | int k; | ||
| 380 : | const int quarterpel = pParam->m_quarterpel; | ||
| 381 : | syskin | 744 | const uint8_t * ptr1, * ptr2; |
| 382 : | syskin | 756 | uint8_t * const tmp = f_refv->u; |
| 383 : | const VECTOR * const fmvs = (quarterpel ? mb->qmvs : mb->mvs); | ||
| 384 : | const VECTOR * const bmvs = (quarterpel ? mb->b_qmvs : mb->b_mvs); | ||
| 385 : | suxen_drol | 118 | |
| 386 : | edgomez | 195 | switch (mb->mode) { |
| 387 : | case MODE_FORWARD: | ||
| 388 : | syskin | 756 | dx = fmvs->x; dy = fmvs->y; |
| 389 : | suxen_drol | 118 | |
| 390 : | syskin | 658 | compensate16x16_interpolate(&dct_codes[0 * 64], cur->y, f_ref->y, f_refh->y, |
| 391 : | syskin | 756 | f_refv->y, f_refhv->y, tmp, 16 * i, 16 * j, dx, |
| 392 : | dy, edged_width, quarterpel, 0, 0); | ||
| 393 : | suxen_drol | 118 | |
| 394 : | syskin | 756 | dx /= 1 + quarterpel; |
| 395 : | dy /= 1 + quarterpel; | ||
| 396 : | CompensateChroma( (dx >> 1) + roundtab_79[dx & 0x3], | ||
| 397 : | (dy >> 1) + roundtab_79[dy & 0x3], | ||
| 398 : | i, j, cur, f_ref, tmp, | ||
| 399 : | &dct_codes[4 * 64], edged_width / 2, 0, 0); | ||
| 400 : | suxen_drol | 118 | |
| 401 : | syskin | 756 | return; |
| 402 : | suxen_drol | 118 | |
| 403 : | edgomez | 195 | case MODE_BACKWARD: |
| 404 : | syskin | 756 | b_dx = bmvs->x; b_dy = bmvs->y; |
| 405 : | suxen_drol | 118 | |
| 406 : | syskin | 658 | compensate16x16_interpolate(&dct_codes[0 * 64], cur->y, b_ref->y, b_refh->y, |
| 407 : | syskin | 756 | b_refv->y, b_refhv->y, tmp, 16 * i, 16 * j, b_dx, |
| 408 : | b_dy, edged_width, quarterpel, 0, 0); | ||
| 409 : | suxen_drol | 118 | |
| 410 : | syskin | 756 | b_dx /= 1 + quarterpel; |
| 411 : | b_dy /= 1 + quarterpel; | ||
| 412 : | CompensateChroma( (b_dx >> 1) + roundtab_79[b_dx & 0x3], | ||
| 413 : | (b_dy >> 1) + roundtab_79[b_dy & 0x3], | ||
| 414 : | i, j, cur, b_ref, tmp, | ||
| 415 : | &dct_codes[4 * 64], edged_width / 2, 0, 0); | ||
| 416 : | suxen_drol | 118 | |
| 417 : | syskin | 756 | return; |
| 418 : | suxen_drol | 118 | |
| 419 : | syskin | 744 | case MODE_INTERPOLATE: /* _could_ use DIRECT, but would be overkill (no 4MV there) */ |
| 420 : | chl | 530 | case MODE_DIRECT_NO4V: |
| 421 : | syskin | 756 | dx = fmvs->x; dy = fmvs->y; |
| 422 : | b_dx = bmvs->x; b_dy = bmvs->y; | ||
| 423 : | chl | 374 | |
| 424 : | syskin | 658 | if (quarterpel) { |
| 425 : | syskin | 744 | |
| 426 : | chl | 769 | if ((dx&3) | (dy&3)) { |
| 427 : | syskin | 756 | interpolate16x16_quarterpel(tmp - i * 16 - j * 16 * edged_width, |
| 428 : | (uint8_t *) f_ref->y, tmp + 32, | ||
| 429 : | tmp + 64, tmp + 96, 16*i, 16*j, dx, dy, edged_width, 0); | ||
| 430 : | ptr1 = tmp; | ||
| 431 : | syskin | 744 | } else ptr1 = f_ref->y + (16*j + dy/4)*edged_width + 16*i + dx/4; // fullpixel position |
| 432 : | chl | 374 | |
| 433 : | chl | 769 | if ((b_dx&3) | (b_dy&3)) { |
| 434 : | syskin | 756 | interpolate16x16_quarterpel(tmp - i * 16 - j * 16 * edged_width + 16, |
| 435 : | (uint8_t *) b_ref->y, tmp + 32, | ||
| 436 : | tmp + 64, tmp + 96, 16*i, 16*j, b_dx, b_dy, edged_width, 0); | ||
| 437 : | ptr2 = tmp + 16; | ||
| 438 : | syskin | 744 | } else ptr2 = b_ref->y + (16*j + b_dy/4)*edged_width + 16*i + b_dx/4; // fullpixel position |
| 439 : | suxen_drol | 118 | |
| 440 : | syskin | 658 | b_dx /= 2; |
| 441 : | b_dy /= 2; | ||
| 442 : | dx /= 2; | ||
| 443 : | dy /= 2; | ||
| 444 : | |||
| 445 : | } else { | ||
| 446 : | syskin | 756 | ptr1 = get_ref(f_ref->y, f_refh->y, f_refv->y, f_refhv->y, |
| 447 : | i, j, 16, dx, dy, edged_width); | ||
| 448 : | syskin | 658 | |
| 449 : | syskin | 756 | ptr2 = get_ref(b_ref->y, b_refh->y, b_refv->y, b_refhv->y, |
| 450 : | i, j, 16, b_dx, b_dy, edged_width); | ||
| 451 : | } | ||
| 452 : | for (k = 0; k < 4; k++) | ||
| 453 : | syskin | 658 | transfer_8to16sub2(&dct_codes[k * 64], |
| 454 : | syskin | 756 | cur->y + (i * 16+(k&1)*8) + (j * 16+((k>>1)*8)) * edged_width, |
| 455 : | ptr1 + (k&1)*8 + (k>>1)*8*edged_width, | ||
| 456 : | ptr2 + (k&1)*8 + (k>>1)*8*edged_width, edged_width); | ||
| 457 : | syskin | 658 | |
| 458 : | suxen_drol | 118 | |
| 459 : | syskin | 658 | dx = (dx >> 1) + roundtab_79[dx & 0x3]; |
| 460 : | dy = (dy >> 1) + roundtab_79[dy & 0x3]; | ||
| 461 : | suxen_drol | 118 | |
| 462 : | syskin | 658 | b_dx = (b_dx >> 1) + roundtab_79[b_dx & 0x3]; |
| 463 : | b_dy = (b_dy >> 1) + roundtab_79[b_dy & 0x3]; | ||
| 464 : | |||
| 465 : | suxen_drol | 118 | break; |
| 466 : | chl | 374 | |
| 467 : | syskin | 756 | default: // MODE_DIRECT |
| 468 : | sumx = sumy = b_sumx = b_sumy = 0; | ||
| 469 : | syskin | 744 | |
| 470 : | syskin | 756 | for (k = 0; k < 4; k++) { |
| 471 : | |||
| 472 : | dx = fmvs[k].x; dy = fmvs[k].y; | ||
| 473 : | b_dx = bmvs[k].x; b_dy = bmvs[k].y; | ||
| 474 : | |||
| 475 : | if (quarterpel) { | ||
| 476 : | sumx += dx/2; sumy += dy/2; | ||
| 477 : | b_sumx += b_dx/2; b_sumy += b_dy/2; | ||
| 478 : | |||
| 479 : | chl | 769 | if ((dx&3) | (dy&3)) { |
| 480 : | syskin | 756 | interpolate8x8_quarterpel(tmp - (i * 16+(k&1)*8) - (j * 16+((k>>1)*8)) * edged_width, |
| 481 : | syskin | 744 | (uint8_t *) f_ref->y, |
| 482 : | syskin | 756 | tmp + 32, tmp + 64, tmp + 96, |
| 483 : | syskin | 744 | 16*i + (k&1)*8, 16*j + (k>>1)*8, dx, dy, edged_width, 0); |
| 484 : | syskin | 756 | ptr1 = tmp; |
| 485 : | syskin | 744 | } else ptr1 = f_ref->y + (16*j + (k>>1)*8 + dy/4)*edged_width + 16*i + (k&1)*8 + dx/4; |
| 486 : | chl | 374 | |
| 487 : | chl | 769 | if ((b_dx&3) | (b_dy&3)) { |
| 488 : | syskin | 756 | interpolate8x8_quarterpel(tmp - (i * 16+(k&1)*8) - (j * 16+((k>>1)*8)) * edged_width + 16, |
| 489 : | (uint8_t *) b_ref->y, | ||
| 490 : | tmp + 16, tmp + 32, tmp + 48, | ||
| 491 : | syskin | 744 | 16*i + (k&1)*8, 16*j + (k>>1)*8, b_dx, b_dy, edged_width, 0); |
| 492 : | syskin | 756 | ptr2 = tmp + 16; |
| 493 : | syskin | 744 | } else ptr2 = b_ref->y + (16*j + (k>>1)*8 + b_dy/4)*edged_width + 16*i + (k&1)*8 + b_dx/4; |
| 494 : | syskin | 756 | } else { |
| 495 : | sumx += dx; sumy += dy; | ||
| 496 : | b_sumx += b_dx; b_sumy += b_dy; | ||
| 497 : | chl | 374 | |
| 498 : | syskin | 756 | ptr1 = get_ref(f_ref->y, f_refh->y, f_refv->y, f_refhv->y, |
| 499 : | 2*i + (k&1), 2*j + (k>>1), 8, dx, dy, edged_width); | ||
| 500 : | ptr2 = get_ref(b_ref->y, b_refh->y, b_refv->y, b_refhv->y, | ||
| 501 : | 2*i + (k&1), 2*j + (k>>1), 8, b_dx, b_dy, edged_width); | ||
| 502 : | } | ||
| 503 : | transfer_8to16sub2(&dct_codes[k * 64], | ||
| 504 : | syskin | 658 | cur->y + (i * 16+(k&1)*8) + (j * 16+((k>>1)*8)) * edged_width, |
| 505 : | syskin | 744 | ptr1, ptr2, edged_width); |
| 506 : | syskin | 756 | |
| 507 : | syskin | 658 | } |
| 508 : | suxen_drol | 449 | |
| 509 : | syskin | 756 | dx = (sumx >> 3) + roundtab_76[sumx & 0xf]; |
| 510 : | dy = (sumy >> 3) + roundtab_76[sumy & 0xf]; | ||
| 511 : | b_dx = (b_sumx >> 3) + roundtab_76[b_sumx & 0xf]; | ||
| 512 : | b_dy = (b_sumy >> 3) + roundtab_76[b_sumy & 0xf]; | ||
| 513 : | chl | 530 | |
| 514 : | suxen_drol | 118 | break; |
| 515 : | } | ||
| 516 : | syskin | 756 | |
| 517 : | // uv block-based chroma interpolation for direct and interpolate modes | ||
| 518 : | transfer_8to16sub2(&dct_codes[4 * 64], | ||
| 519 : | cur->u + (j * 8) * edged_width / 2 + (i * 8), | ||
| 520 : | interpolate8x8_switch2(tmp, b_ref->u, 8 * i, 8 * j, | ||
| 521 : | b_dx, b_dy, edged_width / 2, 0), | ||
| 522 : | interpolate8x8_switch2(tmp + 8, f_ref->u, 8 * i, 8 * j, | ||
| 523 : | dx, dy, edged_width / 2, 0), | ||
| 524 : | edged_width / 2); | ||
| 525 : | |||
| 526 : | transfer_8to16sub2(&dct_codes[5 * 64], | ||
| 527 : | cur->v + (j * 8) * edged_width / 2 + (i * 8), | ||
| 528 : | interpolate8x8_switch2(tmp, b_ref->v, 8 * i, 8 * j, | ||
| 529 : | b_dx, b_dy, edged_width / 2, 0), | ||
| 530 : | interpolate8x8_switch2(tmp + 8, f_ref->v, 8 * i, 8 * j, | ||
| 531 : | dx, dy, edged_width / 2, 0), | ||
| 532 : | edged_width / 2); | ||
| 533 : | suxen_drol | 118 | } |
| 534 : | chl | 769 | |
| 535 : | |||
| 536 : | |||
| 537 : | void | ||
| 538 : | generate_GMCparameters( const int num_wp, // [input]: number of warppoints | ||
| 539 : | const int res, // [input]: resolution | ||
| 540 : | const WARPPOINTS *const warp, // [input]: warp points | ||
| 541 : | const int width, const int height, | ||
| 542 : | GMC_DATA *const gmc) // [output] precalculated parameters | ||
| 543 : | { | ||
| 544 : | |||
| 545 : | /* We follow mainly two sources: The original standard, which is ugly, and the | ||
| 546 : | thesis from Andreas Dehnhardt, which is much nicer. | ||
| 547 : | |||
| 548 : | Notation is: indices are written next to the variable, | ||
| 549 : | primes in the standard are denoted by a suffix 'p'. | ||
| 550 : | types are "c"=constant, "i"=input parameter, "f"=calculated, then fixed, | ||
| 551 : | "o"=output data, " "=other, "u" = unused, "p"=calc for every pixel | ||
| 552 : | |||
| 553 : | type | variable name | ISO name (TeX-style) | value or range | usage | ||
| 554 : | ------------------------------------------------------------------------------------- | ||
| 555 : | c | H | H | [16 , ?] | image width (w/o edges) | ||
| 556 : | c | W | W | [16 , ?] | image height (w/o edges) | ||
| 557 : | |||
| 558 : | c | i0 | i_0 | 0 | ref. point #1, X | ||
| 559 : | c | j0 | j_0 | 0 | ref. point #1, Y | ||
| 560 : | c | i1 | i_1 | W | ref. point #2, X | ||
| 561 : | c | j1 | j_1 | 0 | ref. point #2, Y | ||
| 562 : | cu | i2 | i_2 | 0 | ref. point #3, X | ||
| 563 : | cu | i2 | j_2 | H | ref. point #3, Y | ||
| 564 : | |||
| 565 : | i | du0 | du[0] | [-16863,16863] | warp vector #1, Y | ||
| 566 : | i | dv0 | dv[0] | [-16863,16863] | warp vector #1, Y | ||
| 567 : | i | du1 | du[1] | [-16863,16863] | warp vector #2, Y | ||
| 568 : | i | dv1 | dv[1] | [-16863,16863] | warp vector #2, Y | ||
| 569 : | iu | du2 | du[2] | [-16863,16863] | warp vector #3, Y | ||
| 570 : | iu | dv2 | dv[2] | [-16863,16863] | warp vector #3, Y | ||
| 571 : | |||
| 572 : | i | s | s | {2,4,8,16} | interpol. resolution | ||
| 573 : | f | sigma | - | log2(s) | X / s == X >> sigma | ||
| 574 : | f | r | r | =16/s | complementary res. | ||
| 575 : | f | rho | \rho | log2(r) | X / r == X >> rho | ||
| 576 : | |||
| 577 : | f | i0s | i'_0 | | | ||
| 578 : | f | j0s | j'_0 | | | ||
| 579 : | f | i1s | i'_1 | | | ||
| 580 : | f | j1s | j'_1 | | | ||
| 581 : | f | i2s | i'_2 | | | ||
| 582 : | f | j2s | j'_2 | | | ||
| 583 : | |||
| 584 : | f | alpha | \alpha | | 2^{alpha-1} < W <= 2^alpha | ||
| 585 : | f | beta | \beta | | 2^{beta-1} < H <= 2^beta | ||
| 586 : | |||
| 587 : | f | Ws | W' | W = 2^{alpha} | scaled width | ||
| 588 : | f | Hs | H' | W = 2^{beta} | scaled height | ||
| 589 : | |||
| 590 : | f | i1ss | i''_1 | "virtual sprite stuff" | ||
| 591 : | f | j1ss | j''_1 | "virtual sprite stuff" | ||
| 592 : | f | i2ss | i''_2 | "virtual sprite stuff" | ||
| 593 : | f | j2ss | j''_2 | "virtual sprite stuff" | ||
| 594 : | */ | ||
| 595 : | |||
| 596 : | /* Some calculations are disabled because we only use 2 warppoints at the moment */ | ||
| 597 : | |||
| 598 : | int du0 = warp->duv[0].x; | ||
| 599 : | int dv0 = warp->duv[0].y; | ||
| 600 : | int du1 = warp->duv[1].x; | ||
| 601 : | int dv1 = warp->duv[1].y; | ||
| 602 : | // int du2 = warp->duv[2].x; | ||
| 603 : | // int dv2 = warp->duv[2].y; | ||
| 604 : | |||
| 605 : | gmc->num_wp = num_wp; | ||
| 606 : | |||
| 607 : | gmc->s = res; /* scaling parameters 2,4,8 or 16 */ | ||
| 608 : | gmc->sigma = log2bin(res-1); /* log2bin(15)=4, log2bin(16)=5, log2bin(17)=5 */ | ||
| 609 : | gmc->r = 16/res; | ||
| 610 : | gmc->rho = 4 - gmc->sigma; /* = log2bin(r-1) */ | ||
| 611 : | |||
| 612 : | gmc->W = width; | ||
| 613 : | gmc->H = height; /* fixed reference coordinates */ | ||
| 614 : | |||
| 615 : | gmc->alpha = log2bin(gmc->W-1); | ||
| 616 : | gmc->Ws= 1<<gmc->alpha; | ||
| 617 : | |||
| 618 : | // gmc->beta = log2bin(gmc->H-1); | ||
| 619 : | // gmc->Hs= 1<<gmc->beta; | ||
| 620 : | |||
| 621 : | // printf("du0=%d dv0=%d du1=%d dv1=%d s=%d sigma=%d W=%d alpha=%d, Ws=%d, rho=%d\n",du0,dv0,du1,dv1,gmc->s,gmc->sigma,gmc->W,gmc->alpha,gmc->Ws,gmc->rho); | ||
| 622 : | |||
| 623 : | /* i2s is only needed for num_wp >= 3, etc. */ | ||
| 624 : | /* the 's' values are in 1/s pel resolution */ | ||
| 625 : | gmc->i0s = res/2 * ( du0 ); | ||
| 626 : | gmc->j0s = res/2 * ( dv0 ); | ||
| 627 : | gmc->i1s = res/2 * (2*width + du1 + du0 ); | ||
| 628 : | gmc->j1s = res/2 * ( dv1 + dv0 ); | ||
| 629 : | // gmc->i2s = res/2 * ( du2 + du0 ); | ||
| 630 : | // gmc->j2s = res/2 * (2*height + dv2 + dv0 ); | ||
| 631 : | |||
| 632 : | /* i2s and i2ss are only needed for num_wp == 3, etc. */ | ||
| 633 : | |||
| 634 : | /* the 'ss' values are in 1/16 pel resolution */ | ||
| 635 : | gmc->i1ss = 16*gmc->Ws + ((gmc->W-gmc->Ws)*(gmc->r*gmc->i0s) + gmc->Ws*(gmc->r*gmc->i1s - 16*gmc->W)) / gmc->W; | ||
| 636 : | gmc->j1ss = ((gmc->W - gmc->Ws)*(gmc->r*gmc->j0s) + gmc->Ws*gmc->r*gmc->j1s) / gmc->W; | ||
| 637 : | |||
| 638 : | // gmc->i2ss = ((gmc->H - gmc->Hs)*(gmc->r*gmc->i0s) + gmc->Hs*(gmc->r*gmc->i2s)) / gmc->H; | ||
| 639 : | // gmc->j2ss = 16*gmc->Hs + ((gmc->H-gmc->Hs)*(gmc->r*gmc->j0s) + gmc->Ws*(gmc->r*gmc->j2s - 16*gmc->H)) / gmc->H; | ||
| 640 : | |||
| 641 : | return; | ||
| 642 : | } | ||
| 643 : | |||
| 644 : | |||
| 645 : | |||
| 646 : | void | ||
| 647 : | generate_GMCimage( const GMC_DATA *const gmc_data, // [input] precalculated data | ||
| 648 : | const IMAGE *const pRef, // [input] | ||
| 649 : | const int mb_width, | ||
| 650 : | const int mb_height, | ||
| 651 : | const int stride, | ||
| 652 : | const int stride2, | ||
| 653 : | const int fcode, // [input] some parameters... | ||
| 654 : | const int32_t quarterpel, // [input] for rounding avgMV | ||
| 655 : | const int reduced_resolution, // [input] ignored | ||
| 656 : | const int32_t rounding, // [input] for rounding image data | ||
| 657 : | MACROBLOCK *const pMBs, // [output] average motion vectors | ||
| 658 : | IMAGE *const pGMC) // [output] full warped image | ||
| 659 : | { | ||
| 660 : | |||
| 661 : | unsigned int mj,mi; | ||
| 662 : | VECTOR avgMV; | ||
| 663 : | |||
| 664 : | for (mj=0;mj<mb_height;mj++) | ||
| 665 : | for (mi=0;mi<mb_width; mi++) | ||
| 666 : | { | ||
| 667 : | avgMV = generate_GMCimageMB(gmc_data, pRef, mi, mj, | ||
| 668 : | stride, stride2, quarterpel, rounding, pGMC); | ||
| 669 : | |||
| 670 : | pMBs[mj*mb_width+mi].amv.x = gmc_sanitize(avgMV.x, quarterpel, fcode); | ||
| 671 : | pMBs[mj*mb_width+mi].amv.y = gmc_sanitize(avgMV.y, quarterpel, fcode); | ||
| 672 : | pMBs[mj*mb_width+mi].mcsel = 0; /* until mode decision */ | ||
| 673 : | } | ||
| 674 : | } | ||
| 675 : | |||
| 676 : | |||
| 677 : | VECTOR generate_GMCimageMB( const GMC_DATA *const gmc_data, /* [input] all precalc data */ | ||
| 678 : | const IMAGE *const pRef, /* [input] */ | ||
| 679 : | const int mi, const int mj, /* [input] MB position */ | ||
| 680 : | const int stride, /* [input] Lumi stride */ | ||
| 681 : | const int stride2, /* [input] chroma stride */ | ||
| 682 : | const int quarterpel, /* [input] for rounding of avgMV */ | ||
| 683 : | const int rounding, /* [input] for rounding of imgae data */ | ||
| 684 : | IMAGE *const pGMC) /* [outut] generate image */ | ||
| 685 : | |||
| 686 : | /* | ||
| 687 : | type | variable name | ISO name (TeX-style) | value or range | usage | ||
| 688 : | ------------------------------------------------------------------------------------- | ||
| 689 : | p | F | F(i,j) | | pelwise motion vector X in s-th pel | ||
| 690 : | p | G | G(i,j) | | pelwise motion vector Y in s-th pel | ||
| 691 : | p | Fc | F_c(i,j) | | | ||
| 692 : | p | Gc | G_c(i,j) | | same for chroma | ||
| 693 : | |||
| 694 : | p | Y00 | Y_{00} | [0,255*s*s] | first: 4 neighbouring Y-values | ||
| 695 : | p | Y01 | Y_{01} | [0,255] | at fullpel position, around the | ||
| 696 : | p | Y10 | Y_{10} | [0,255*s] | position where pelweise MV points to | ||
| 697 : | p | Y11 | Y_{11} | [0,255] | later: bilinear interpol Y-values in Y00 | ||
| 698 : | |||
| 699 : | p | C00 | C_{00} | [0,255*s*s] | same for chroma Cb and Cr | ||
| 700 : | p | C01 | C_{01} | [0,255] | | ||
| 701 : | p | C10 | C_{10} | [0,255*s] | | ||
| 702 : | p | C11 | C_{11} | [0,255] | | ||
| 703 : | |||
| 704 : | */ | ||
| 705 : | { | ||
| 706 : | const int W = gmc_data->W; | ||
| 707 : | const int H = gmc_data->H; | ||
| 708 : | |||
| 709 : | const int s = gmc_data->s; | ||
| 710 : | const int sigma = gmc_data->sigma; | ||
| 711 : | |||
| 712 : | const int r = gmc_data->r; | ||
| 713 : | const int rho = gmc_data->rho; | ||
| 714 : | |||
| 715 : | const int i0s = gmc_data->i0s; | ||
| 716 : | const int j0s = gmc_data->j0s; | ||
| 717 : | |||
| 718 : | const int i1ss = gmc_data->i1ss; | ||
| 719 : | const int j1ss = gmc_data->j1ss; | ||
| 720 : | // const int i2ss = gmc_data->i2ss; | ||
| 721 : | // const int j2ss = gmc_data->j2ss; | ||
| 722 : | |||
| 723 : | const int alpha = gmc_data->alpha; | ||
| 724 : | const int Ws = gmc_data->Ws; | ||
| 725 : | |||
| 726 : | // const int beta = gmc_data->beta; | ||
| 727 : | // const int Hs = gmc_data->Hs; | ||
| 728 : | |||
| 729 : | int I,J; | ||
| 730 : | VECTOR avgMV = {0,0}; | ||
| 731 : | |||
| 732 : | for (J=16*mj;J<16*(mj+1);J++) | ||
| 733 : | for (I=16*mi;I<16*(mi+1);I++) | ||
| 734 : | { | ||
| 735 : | int F= i0s + ( ((-r*i0s+i1ss)*I + (r*j0s-j1ss)*J + (1<<(alpha+rho-1))) >> (alpha+rho) ); | ||
| 736 : | int G= j0s + ( ((-r*j0s+j1ss)*I + (-r*i0s+i1ss)*J + (1<<(alpha+rho-1))) >> (alpha+rho) ); | ||
| 737 : | |||
| 738 : | /* this naive implementation (with lots of multiplications) isn't slower (rather faster) than | ||
| 739 : | working incremental. Don't ask me why... maybe the whole this is memory bound? */ | ||
| 740 : | |||
| 741 : | const int ri= F & (s-1); // fractional part of pelwise MV X | ||
| 742 : | const int rj= G & (s-1); // fractional part of pelwise MV Y | ||
| 743 : | |||
| 744 : | int Y00,Y01,Y10,Y11; | ||
| 745 : | |||
| 746 : | /* unclipped values are used for avgMV */ | ||
| 747 : | avgMV.x += F-(I<<sigma); /* shift position to 1/s-pel, as the MV is */ | ||
| 748 : | avgMV.y += G-(J<<sigma); /* TODO: don't do this (of course) */ | ||
| 749 : | |||
| 750 : | F >>= sigma; | ||
| 751 : | G >>= sigma; | ||
| 752 : | |||
| 753 : | /* clip values to be in range. Since we have edges, clip to 1 less than lower boundary | ||
| 754 : | this way positions F+1/G+1 are still right */ | ||
| 755 : | |||
| 756 : | if (F< -1) | ||
| 757 : | F=-1; | ||
| 758 : | else if (F>W) | ||
| 759 : | F=W; /* W or W-1 doesn't matter, so save 1 subtract ;-) */ | ||
| 760 : | if (G< -1) | ||
| 761 : | G=-1; | ||
| 762 : | else if (G>H) | ||
| 763 : | G=H; /* dito */ | ||
| 764 : | |||
| 765 : | Y00 = pRef->y[ G*stride + F ]; // Lumi values | ||
| 766 : | Y01 = pRef->y[ G*stride + F+1 ]; | ||
| 767 : | Y10 = pRef->y[ G*stride + F+stride ]; | ||
| 768 : | Y11 = pRef->y[ G*stride + F+stride+1 ]; | ||
| 769 : | |||
| 770 : | /* bilinear interpolation */ | ||
| 771 : | Y00 = ((s-ri)*Y00 + ri*Y01); | ||
| 772 : | Y10 = ((s-ri)*Y10 + ri*Y11); | ||
| 773 : | Y00 = ((s-rj)*Y00 + rj*Y10 + s*s/2 - rounding ) >> (sigma+sigma); | ||
| 774 : | |||
| 775 : | pGMC->y[J*stride+I] = (uint8_t)Y00; /* output 1 Y-pixel */ | ||
| 776 : | } | ||
| 777 : | |||
| 778 : | |||
| 779 : | /* doing chroma _here_ is even more stupid and slow, because won't be used until Compensation and | ||
| 780 : | most likely not even then (only if the block really _is_ GMC) | ||
| 781 : | */ | ||
| 782 : | |||
| 783 : | for (J=8*mj;J<8*(mj+1);J++) /* this plays the role of j_c,i_c in the standard */ | ||
| 784 : | for (I=8*mi;I<8*(mi+1);I++) /* For I_c we have to use I_c = 4*i_c+1 ! */ | ||
| 785 : | { | ||
| 786 : | /* same positions for both chroma components, U=Cb and V=Cr */ | ||
| 787 : | int Fc=((-r*i0s+i1ss)*(4*I+1) + (r*j0s-j1ss)*(4*J+1) +2*Ws*r*i0s | ||
| 788 : | -16*Ws +(1<<(alpha+rho+1)))>>(alpha+rho+2); | ||
| 789 : | int Gc=((-r*j0s+j1ss)*(4*I+1) +(-r*i0s+i1ss)*(4*J+1) +2*Ws*r*j0s | ||
| 790 : | -16*Ws +(1<<(alpha+rho+1))) >>(alpha+rho+2); | ||
| 791 : | |||
| 792 : | const int ri= Fc & (s-1); // fractional part of pelwise MV X | ||
| 793 : | const int rj= Gc & (s-1); // fractional part of pelwise MV Y | ||
| 794 : | |||
| 795 : | int C00,C01,C10,C11; | ||
| 796 : | |||
| 797 : | Fc >>= sigma; | ||
| 798 : | Gc >>= sigma; | ||
| 799 : | |||
| 800 : | if (Fc< -1) | ||
| 801 : | Fc=-1; | ||
| 802 : | else if (Fc>=W/2) | ||
| 803 : | Fc=W/2; /* W or W-1 doesn't matter, so save 1 subtraction ;-) */ | ||
| 804 : | if (Gc< -1) | ||
| 805 : | Gc=-1; | ||
| 806 : | else if (Gc>=H/2) | ||
| 807 : | Gc=H/2; /* dito */ | ||
| 808 : | |||
| 809 : | /* now calculate U data */ | ||
| 810 : | C00 = pRef->u[ Gc*stride2 + Fc ]; // chroma-value Cb | ||
| 811 : | C01 = pRef->u[ Gc*stride2 + Fc+1 ]; | ||
| 812 : | C10 = pRef->u[ (Gc+1)*stride2 + Fc ]; | ||
| 813 : | C11 = pRef->u[ (Gc+1)*stride2 + Fc+1 ]; | ||
| 814 : | |||
| 815 : | /* bilinear interpolation */ | ||
| 816 : | C00 = ((s-ri)*C00 + ri*C01); | ||
| 817 : | C10 = ((s-ri)*C10 + ri*C11); | ||
| 818 : | C00 = ((s-rj)*C00 + rj*C10 + s*s/2 - rounding ) >> (sigma+sigma); | ||
| 819 : | |||
| 820 : | pGMC->u[J*stride2+I] = (uint8_t)C00; /* output 1 U-pixel */ | ||
| 821 : | |||
| 822 : | /* now calculate V data */ | ||
| 823 : | C00 = pRef->v[ Gc*stride2 + Fc ]; // chroma-value Cr | ||
| 824 : | C01 = pRef->v[ Gc*stride2 + Fc+1 ]; | ||
| 825 : | C10 = pRef->v[ (Gc+1)*stride2 + Fc ]; | ||
| 826 : | C11 = pRef->v[ (Gc+1)*stride2 + Fc+1 ]; | ||
| 827 : | |||
| 828 : | /* bilinear interpolation */ | ||
| 829 : | C00 = ((s-ri)*C00 + ri*C01); | ||
| 830 : | C10 = ((s-ri)*C10 + ri*C11); | ||
| 831 : | C00 = ((s-rj)*C00 + rj*C10 + s*s/2 - rounding ) >> (sigma+sigma); | ||
| 832 : | |||
| 833 : | pGMC->v[J*stride2+I] = (uint8_t)C00; /* output 1 V-pixel */ | ||
| 834 : | } | ||
| 835 : | |||
| 836 : | |||
| 837 : | |||
| 838 : | /* The average vector is rounded from 1/s-pel to 1/2 or 1/4 */ | ||
| 839 : | if (quarterpel) | ||
| 840 : | { /* >>8 because of 256 terms in sum, >>(sigma-2) to obtain 1/4th-pel */ | ||
| 841 : | avgMV.x = ( (avgMV.x + (1<<(sigma+5)) )>>(sigma+6) ); | ||
| 842 : | avgMV.y = ( (avgMV.y + (1<<(sigma+5)) )>>(sigma+6) ); | ||
| 843 : | } | ||
| 844 : | else | ||
| 845 : | { /* >>8 because of 256 terms in sum, >>(sigma-1) to obtain 1/2th-pel */ | ||
| 846 : | avgMV.x = ( (avgMV.x + (1<<(sigma+6)))>>(sigma+7) ); | ||
| 847 : | avgMV.y = ( (avgMV.y + (1<<(sigma+6)))>>(sigma+7) ); | ||
| 848 : | } /* TODO: Check if this is correct way of rounding */ | ||
| 849 : | |||
| 850 : | return avgMV; /* clipping to fcode area is done outside! */ | ||
| 851 : | } | ||
| 852 : |
| No admin address has been configured | ViewVC Help |
| Powered by ViewVC 1.0.4 |