display.c 2.1 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273
  1. /*
  2. * Copyright (c) 2014 Vittorio Giovara <vittorio.giovara@gmail.com>
  3. *
  4. * This file is part of FFmpeg.
  5. *
  6. * FFmpeg is free software; you can redistribute it and/or
  7. * modify it under the terms of the GNU Lesser General Public
  8. * License as published by the Free Software Foundation; either
  9. * version 2.1 of the License, or (at your option) any later version.
  10. *
  11. * FFmpeg is distributed in the hope that it will be useful,
  12. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  14. * Lesser General Public License for more details.
  15. *
  16. * You should have received a copy of the GNU Lesser General Public
  17. * License along with FFmpeg; if not, write to the Free Software
  18. * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
  19. */
  20. #include <stdint.h>
  21. #include <string.h>
  22. #include <math.h>
  23. #include "display.h"
  24. #include "mathematics.h"
  25. // fixed point to double
  26. #define CONV_FP(x) ((double) (x)) / (1 << 16)
  27. // double to fixed point
  28. #define CONV_DB(x) (int32_t) ((x) * (1 << 16))
  29. double av_display_rotation_get(const int32_t matrix[9])
  30. {
  31. double rotation, scale[2];
  32. scale[0] = hypot(CONV_FP(matrix[0]), CONV_FP(matrix[3]));
  33. scale[1] = hypot(CONV_FP(matrix[1]), CONV_FP(matrix[4]));
  34. if (scale[0] == 0.0 || scale[1] == 0.0)
  35. return NAN;
  36. rotation = atan2(CONV_FP(matrix[1]) / scale[1],
  37. CONV_FP(matrix[0]) / scale[0]) * 180 / M_PI;
  38. return -rotation;
  39. }
  40. void av_display_rotation_set(int32_t matrix[9], double angle)
  41. {
  42. double radians = -angle * M_PI / 180.0f;
  43. double c = cos(radians);
  44. double s = sin(radians);
  45. memset(matrix, 0, 9 * sizeof(int32_t));
  46. matrix[0] = CONV_DB(c);
  47. matrix[1] = CONV_DB(-s);
  48. matrix[3] = CONV_DB(s);
  49. matrix[4] = CONV_DB(c);
  50. matrix[8] = 1 << 30;
  51. }
  52. void av_display_matrix_flip(int32_t matrix[9], int hflip, int vflip)
  53. {
  54. int i;
  55. const int flip[] = { 1 - 2 * (!!hflip), 1 - 2 * (!!vflip), 1 };
  56. if (hflip || vflip)
  57. for (i = 0; i < 9; i++)
  58. matrix[i] *= flip[i % 3];
  59. }