path: root/src/gallium/auxiliary/vl/vl_compositor.c

/**************************************************************************
 *
 * Copyright 2009 Younes Manton.
 * All Rights Reserved.
 *
 * Permission is hereby granted, free of charge, to any person obtaining a
 * copy of this software and associated documentation files (the
 * "Software"), to deal in the Software without restriction, including
 * without limitation the rights to use, copy, modify, merge, publish,
 * distribute, sub license, and/or sell copies of the Software, and to
 * permit persons to whom the Software is furnished to do so, subject to
 * the following conditions:
 *
 * The above copyright notice and this permission notice (including the
 * next paragraph) shall be included in all copies or substantial portions
 * of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
 * OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT.
 * IN NO EVENT SHALL TUNGSTEN GRAPHICS AND/OR ITS SUPPLIERS BE LIABLE FOR
 * ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
 * TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
 * SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
 *
 **************************************************************************/

#include "vl_compositor.h"
#include "util/u_draw.h"
#include <assert.h>
#include <pipe/p_context.h>
#include <util/u_inlines.h>
#include <util/u_memory.h>
#include <util/u_keymap.h>
#include <util/u_draw.h>
#include <util/u_sampler.h>
#include <tgsi/tgsi_ureg.h>
#include "vl_csc.h"

struct vertex_shader_consts
{
   struct vertex4f dst_scale;
   struct vertex4f dst_trans;
   struct vertex4f src_scale;
   struct vertex4f src_trans;
};

struct fragment_shader_consts
{
   float matrix[16];
};

static bool
u_video_rects_equal(struct pipe_video_rect *a, struct pipe_video_rect *b)
{
   assert(a && b);

   if (a->x != b->x)
      return false;
   if (a->y != b->y)
      return false;
   if (a->w != b->w)
      return false;
   if (a->h != b->h)
      return false;

   return true;
}

static bool
create_vert_shader(struct vl_compositor *c)
{
   struct ureg_program *shader;
   struct ureg_src vpos, vtex;
   struct ureg_dst o_vpos, o_vtex;

   shader = ureg_create(TGSI_PROCESSOR_VERTEX);
   if (!shader)
      return false;

   vpos = ureg_DECL_vs_input(shader, 0);
   vtex = ureg_DECL_vs_input(shader, 1);
   o_vpos = ureg_DECL_output(shader, TGSI_SEMANTIC_POSITION, 0);
   o_vtex = ureg_DECL_output(shader, TGSI_SEMANTIC_GENERIC, 1);

   /*
    * o_vpos = vpos
    * o_vtex = vtex
    */
   ureg_MOV(shader, o_vpos, vpos);
   ureg_MOV(shader, o_vtex, vtex);

   ureg_END(shader);

   c->vertex_shader = ureg_create_shader_and_destroy(shader, c->pipe);
   if (!c->vertex_shader)
      return false;

   return true;
}

static bool
create_frag_shader_ycbcr_2_rgb(struct vl_compositor *c)
{
   struct ureg_program *shader;
   struct ureg_src tc;
   struct ureg_src csc[4];
   struct ureg_src sampler;
   struct ureg_dst texel;
   struct ureg_dst fragment;
   unsigned i;

   shader = ureg_create(TGSI_PROCESSOR_FRAGMENT);
   if (!shader)
      return false;

   tc = ureg_DECL_fs_input(shader, TGSI_SEMANTIC_GENERIC, 1, TGSI_INTERPOLATE_LINEAR);
   for (i = 0; i < 4; ++i)
      csc[i] = ureg_DECL_constant(shader, i);
   sampler = ureg_DECL_sampler(shader, 0);
   texel = ureg_DECL_temporary(shader);
   fragment = ureg_DECL_output(shader, TGSI_SEMANTIC_COLOR, 0);

   /*
    * texel = tex(tc, sampler)
    * fragment = csc * texel
    */
   ureg_TEX(shader, texel, TGSI_TEXTURE_2D, tc, sampler);
   for (i = 0; i < 3; ++i)
      ureg_DP4(shader, ureg_writemask(fragment, TGSI_WRITEMASK_X << i), csc[i], ureg_src(texel));
   ureg_MOV(shader, ureg_writemask(fragment, TGSI_WRITEMASK_W), ureg_imm1f(shader, 1.0f));

   ureg_release_temporary(shader, texel);
   ureg_END(shader);

   c->fragment_shader.ycbcr_2_rgb = ureg_create_shader_and_destroy(shader, c->pipe);
   if (!c->fragment_shader.ycbcr_2_rgb)
      return false;

   return true;
}

static bool
create_frag_shader_palette_2_rgb(struct vl_compositor *c)
{
   struct ureg_program *shader;
   struct ureg_src tc;
   struct ureg_src sampler;
   struct ureg_src palette;
   struct ureg_dst texel;
   struct ureg_dst fragment;

   shader = ureg_create(TGSI_PROCESSOR_FRAGMENT);
   if (!shader)
      return false;

   tc = ureg_DECL_fs_input(shader, TGSI_SEMANTIC_GENERIC, 1, TGSI_INTERPOLATE_LINEAR);
   sampler = ureg_DECL_sampler(shader, 0);
   palette = ureg_DECL_sampler(shader, 1);
   fragment = ureg_DECL_output(shader, TGSI_SEMANTIC_COLOR, 0);
   texel = ureg_DECL_temporary(shader);

   /*
    * fragment = tex(tc, sampler)
    */
   ureg_TEX(shader, texel, TGSI_TEXTURE_2D, tc, sampler);
   ureg_TEX(shader, fragment, TGSI_TEXTURE_1D, ureg_src(texel), palette);
   ureg_MOV(shader, ureg_writemask(fragment, TGSI_WRITEMASK_W), ureg_src(texel));

   ureg_release_temporary(shader, texel);
   ureg_END(shader);

   c->fragment_shader.palette_2_rgb = ureg_create_shader_and_destroy(shader, c->pipe);
   if (!c->fragment_shader.palette_2_rgb)
      return false;

   return true;
}

static bool
create_frag_shader_rgb_2_rgb(struct vl_compositor *c)
{
   struct ureg_program *shader;
   struct ureg_src tc;
   struct ureg_src sampler;
   struct ureg_dst fragment;

   shader = ureg_create(TGSI_PROCESSOR_FRAGMENT);
   if (!shader)
      return false;

   tc = ureg_DECL_fs_input(shader, TGSI_SEMANTIC_GENERIC, 1, TGSI_INTERPOLATE_LINEAR);
   sampler = ureg_DECL_sampler(shader, 0);
   fragment = ureg_DECL_output(shader, TGSI_SEMANTIC_COLOR, 0);

   /*
    * fragment = tex(tc, sampler)
    */
   ureg_TEX(shader, fragment, TGSI_TEXTURE_2D, tc, sampler);
   ureg_END(shader);

   c->fragment_shader.rgb_2_rgb = ureg_create_shader_and_destroy(shader, c->pipe);
   if (!c->fragment_shader.rgb_2_rgb)
      return false;

   return true;
}

static bool
init_pipe_state(struct vl_compositor *c)
{
   struct pipe_sampler_state sampler;
   struct pipe_blend_state blend;

   assert(c);

   c->fb_state.nr_cbufs = 1;
   c->fb_state.zsbuf = NULL;

   memset(&sampler, 0, sizeof(sampler));
   sampler.wrap_s = PIPE_TEX_WRAP_CLAMP_TO_EDGE;
   sampler.wrap_t = PIPE_TEX_WRAP_CLAMP_TO_EDGE;
   sampler.wrap_r = PIPE_TEX_WRAP_CLAMP_TO_EDGE;
   sampler.min_img_filter = PIPE_TEX_FILTER_LINEAR;
   sampler.min_mip_filter = PIPE_TEX_MIPFILTER_NONE;
   sampler.mag_img_filter = PIPE_TEX_FILTER_LINEAR;
   sampler.compare_mode = PIPE_TEX_COMPARE_NONE;
   sampler.compare_func = PIPE_FUNC_ALWAYS;
   sampler.normalized_coords = 1;
   /*sampler.lod_bias = ;*/
   /*sampler.min_lod = ;*/
   /*sampler.max_lod = ;*/
   /*sampler.border_color[i] = ;*/
   /*sampler.max_anisotropy = ;*/
   c->sampler = c->pipe->create_sampler_state(c->pipe, &sampler);

   memset(&blend, 0, sizeof blend);
   blend.independent_blend_enable = 0;
   blend.rt[0].blend_enable = 1;
   blend.rt[0].rgb_func = PIPE_BLEND_ADD;
   blend.rt[0].rgb_src_factor = PIPE_BLENDFACTOR_SRC_ALPHA;
   blend.rt[0].rgb_dst_factor = PIPE_BLENDFACTOR_INV_SRC_ALPHA;
   blend.rt[0].alpha_func = PIPE_BLEND_ADD;
   blend.rt[0].alpha_src_factor = PIPE_BLENDFACTOR_ONE;
   blend.rt[0].alpha_dst_factor = PIPE_BLENDFACTOR_ONE;
   blend.logicop_enable = 0;
   blend.logicop_func = PIPE_LOGICOP_CLEAR;
   blend.rt[0].colormask = PIPE_MASK_RGBA;
   blend.dither = 0;
   c->blend = c->pipe->create_blend_state(c->pipe, &blend);

   return true;
}

static void cleanup_pipe_state(struct vl_compositor *c)
{
   assert(c);

   c->pipe->delete_sampler_state(c->pipe, c->sampler);
   c->pipe->delete_blend_state(c->pipe, c->blend);
}

static bool
init_shaders(struct vl_compositor *c)
{
   assert(c);

   if (!create_vert_shader(c)) {
      debug_printf("Unable to create vertex shader.\n");
      return false;
   }
   if (!create_frag_shader_ycbcr_2_rgb(c)) {
      debug_printf("Unable to create YCbCr-to-RGB fragment shader.\n");
      return false;
   }
   if (!create_frag_shader_palette_2_rgb(c)) {
      debug_printf("Unable to create Palette-to-RGB fragment shader.\n");
      return false;
   }
   if (!create_frag_shader_rgb_2_rgb(c)) {
      debug_printf("Unable to create RGB-to-RGB fragment shader.\n");
      return false;
   }

   return true;
}

static void cleanup_shaders(struct vl_compositor *c)
{
   assert(c);

   c->pipe->delete_vs_state(c->pipe, c->vertex_shader);
   c->pipe->delete_fs_state(c->pipe, c->fragment_shader.ycbcr_2_rgb);
   c->pipe->delete_fs_state(c->pipe, c->fragment_shader.palette_2_rgb);
   c->pipe->delete_fs_state(c->pipe, c->fragment_shader.rgb_2_rgb);
}

static bool
init_buffers(struct vl_compositor *c)
{
   struct fragment_shader_consts fsc;
   struct pipe_vertex_element vertex_elems[2];

   assert(c);

   /*
    * Create our vertex buffer and vertex buffer elements
    */
   c->vertex_buf.stride = sizeof(struct vertex4f);
   c->vertex_buf.buffer_offset = 0;
   /* XXX: Create with DYNAMIC or STREAM */
   c->vertex_buf.buffer = pipe_buffer_create
   (
      c->pipe->screen,
      PIPE_BIND_VERTEX_BUFFER,
      PIPE_USAGE_STATIC,
      sizeof(struct vertex4f) * (VL_COMPOSITOR_MAX_LAYERS + 1) * 4
   );

   vertex_elems[0].src_offset = 0;
   vertex_elems[0].instance_divisor = 0;
   vertex_elems[0].vertex_buffer_index = 0;
   vertex_elems[0].src_format = PIPE_FORMAT_R32G32_FLOAT;
   vertex_elems[1].src_offset = sizeof(struct vertex2f);
   vertex_elems[1].instance_divisor = 0;
   vertex_elems[1].vertex_buffer_index = 0;
   vertex_elems[1].src_format = PIPE_FORMAT_R32G32_FLOAT;
   c->vertex_elems_state = c->pipe->create_vertex_elements_state(c->pipe, 2, vertex_elems);

   /*
    * Create our fragment shader's constant buffer
    * Const buffer contains the color conversion matrix and bias vectors
    */
   /* XXX: Create with IMMUTABLE/STATIC... although it does change every once in a long while... */
   c->fs_const_buf = pipe_buffer_create
   (
      c->pipe->screen,
      PIPE_BIND_CONSTANT_BUFFER,
      PIPE_USAGE_STATIC,
      sizeof(struct fragment_shader_consts)
   );

   vl_csc_get_matrix(VL_CSC_COLOR_STANDARD_IDENTITY, NULL, true, fsc.matrix);

   vl_compositor_set_csc_matrix(c, fsc.matrix);

   return true;
}

static void
cleanup_buffers(struct vl_compositor *c)
{
   assert(c);

   c->pipe->delete_vertex_elements_state(c->pipe, c->vertex_elems_state);
   pipe_resource_reference(&c->vertex_buf.buffer, NULL);
   pipe_resource_reference(&c->fs_const_buf, NULL);
}

bool vl_compositor_init(struct vl_compositor *compositor, struct pipe_context *pipe)
{
   unsigned i;

   assert(compositor);

   memset(compositor, 0, sizeof(struct vl_compositor));

   compositor->pipe = pipe;

   if (!init_pipe_state(compositor))
      return false;

   if (!init_shaders(compositor)) {
      cleanup_pipe_state(compositor);
      return false;
   }
   if (!init_buffers(compositor)) {
      cleanup_shaders(compositor);
      cleanup_pipe_state(compositor);
      return false;
   }

   compositor->fb_state.width = 0;
   compositor->fb_state.height = 0;
   for (i = 0; i < VL_COMPOSITOR_MAX_LAYERS; ++i)
      compositor->layers[i] = NULL;
   compositor->dirty_layers = 0;

   return true;
}

void vl_compositor_cleanup(struct vl_compositor *compositor)
{
   assert(compositor);

   cleanup_buffers(compositor);
   cleanup_shaders(compositor);
   cleanup_pipe_state(compositor);
}

void vl_compositor_set_layers(struct vl_compositor *compositor,
                              struct pipe_sampler_view *layers[],
                              struct pipe_sampler_view *palettes[],
                              struct pipe_video_rect *src_rects[],
                              struct pipe_video_rect *dst_rects[],
                              unsigned num_layers)
{
   unsigned i;

   assert(compositor);
   assert(num_layers <= VL_COMPOSITOR_MAX_LAYERS);

   for (i = 0; i < num_layers; ++i)
   {
      assert((layers[i] && src_rects[i] && dst_rects[i]) ||
             (!layers[i] && !src_rects[i] && !dst_rects[i]));

      if (compositor->layers[i] != layers[i] ||
          compositor->palettes[i] != palettes[i] ||
          !u_video_rects_equal(&compositor->layer_src_rects[i], src_rects[i]) ||
          !u_video_rects_equal(&compositor->layer_dst_rects[i], dst_rects[i]))
      {
         pipe_sampler_view_reference(&compositor->layers[i], layers[i]);
         pipe_sampler_view_reference(&compositor->palettes[i], palettes[i]);
         compositor->layer_src_rects[i] = *src_rects[i];
         compositor->layer_dst_rects[i] = *dst_rects[i];
         compositor->dirty_layers |= 1 << i;
      }

      if (layers[i])
         compositor->dirty_layers |= 1 << i;
   }

   for (; i < VL_COMPOSITOR_MAX_LAYERS; ++i) {
      pipe_sampler_view_reference(&compositor->layers[i], NULL);
      pipe_sampler_view_reference(&compositor->palettes[i], NULL);
   }
}

static void gen_rect_verts(struct pipe_video_rect *src_rect,
                           struct vertex2f *src_inv_size,
                           struct pipe_video_rect *dst_rect,
                           struct vertex2f *dst_inv_size,
                           struct vertex4f *vb)
{
   assert(src_rect);
   assert(src_inv_size);
   assert((dst_rect && dst_inv_size) /*|| (!dst_rect && !dst_inv_size)*/);
   assert(vb);

   vb[0].x = dst_rect->x * dst_inv_size->x;
   vb[0].y = dst_rect->y * dst_inv_size->y;
   vb[0].z = src_rect->x * src_inv_size->x;
   vb[0].w = src_rect->y * src_inv_size->y;

   vb[1].x = (dst_rect->x + dst_rect->w) * dst_inv_size->x;
   vb[1].y = dst_rect->y * dst_inv_size->y;
   vb[1].z = (src_rect->x + src_rect->w) * src_inv_size->x;
   vb[1].w = src_rect->y * src_inv_size->y;

   vb[2].x = (dst_rect->x + dst_rect->w) * dst_inv_size->x;
   vb[2].y = (dst_rect->y + dst_rect->h) * dst_inv_size->y;
   vb[2].z = (src_rect->x + src_rect->w) * src_inv_size->x;
   vb[2].w = (src_rect->y + src_rect->h) * src_inv_size->y;

   vb[3].x = dst_rect->x * dst_inv_size->x;
   vb[3].y = (dst_rect->y + dst_rect->h) * dst_inv_size->y;
   vb[3].z = src_rect->x * src_inv_size->x;
   vb[3].w = (src_rect->y + src_rect->h) * src_inv_size->y;
}

static unsigned gen_data(struct vl_compositor *c,
                         struct pipe_sampler_view *src_surface,
                         struct pipe_video_rect *src_rect,
                         struct pipe_video_rect *dst_rect,
                         struct pipe_sampler_view *textures[VL_COMPOSITOR_MAX_LAYERS + 1][2],
                         void **frag_shaders)
{
   struct vertex4f *vb;
   struct pipe_transfer *buf_transfer;
   unsigned num_rects = 0;
   unsigned i;

   assert(c);
   assert(src_surface);
   assert(src_rect);
   assert(dst_rect);
   assert(textures);

   vb = pipe_buffer_map(c->pipe, c->vertex_buf.buffer,
                        PIPE_TRANSFER_WRITE | PIPE_TRANSFER_DISCARD,
                        &buf_transfer);

   if (!vb)
      return 0;

   {
      struct vertex2f src_inv_size = { 1.0f / src_surface->texture->width0, 1.0f / src_surface->texture->height0};
      gen_rect_verts(src_rect, &src_inv_size, dst_rect, &c->fb_inv_size, vb);
      textures[num_rects][0] = src_surface;
      textures[num_rects][1] = NULL;
      /* XXX: Hack, sort of */
      frag_shaders[num_rects] = c->fragment_shader.ycbcr_2_rgb;
      ++num_rects;
      vb += 4;
   }

   for (i = 0; c->dirty_layers > 0; i++) {
      assert(i < VL_COMPOSITOR_MAX_LAYERS);

      if (c->dirty_layers & (1 << i)) {
         struct vertex2f layer_inv_size = {1.0f / c->layers[i]->texture->width0, 1.0f / c->layers[i]->texture->height0};
         gen_rect_verts(&c->layer_src_rects[i], &layer_inv_size, &c->layer_dst_rects[i], &layer_inv_size, vb);
         textures[num_rects][0] = c->layers[i];
         textures[num_rects][1] = c->palettes[i];

         if (c->palettes[i])
            frag_shaders[num_rects] = c->fragment_shader.palette_2_rgb;
         else
            frag_shaders[num_rects] = c->fragment_shader.rgb_2_rgb;

         ++num_rects;
         vb += 4;
         c->dirty_layers &= ~(1 << i);
      }
   }

   pipe_buffer_unmap(c->pipe, buf_transfer);

   return num_rects;
}

static void draw_layers(struct vl_compositor *c,
                        struct pipe_sampler_view *src_surface,
                        struct pipe_video_rect *src_rect,
                        struct pipe_video_rect *dst_rect)
{
   unsigned num_rects;
   struct pipe_sampler_view *surfaces[VL_COMPOSITOR_MAX_LAYERS + 1][2];
   void *frag_shaders[VL_COMPOSITOR_MAX_LAYERS + 1];
   unsigned i;

   assert(c);
   assert(src_surface);
   assert(src_rect);
   assert(dst_rect);

   num_rects = gen_data(c, src_surface, src_rect, dst_rect, surfaces, frag_shaders);

   c->pipe->bind_blend_state(c->pipe, c->blend);
   for (i = 0; i < num_rects; ++i) {
      c->pipe->bind_fs_state(c->pipe, frag_shaders[i]);
      c->pipe->set_fragment_sampler_views(c->pipe, surfaces[i][1] ? 2 : 1, &surfaces[i][0]);

      util_draw_arrays(c->pipe, PIPE_PRIM_QUADS, i * 4, 4);
   }
}

void vl_compositor_render(struct vl_compositor          *compositor,
                          struct pipe_sampler_view      *src_surface,
                          enum pipe_mpeg12_picture_type picture_type,
                          struct pipe_video_rect        *src_area,
                          struct pipe_surface           *dst_surface,
                          struct pipe_video_rect        *dst_area,
                          struct pipe_fence_handle      **fence)
{
   void *samplers[2];

   assert(compositor);
   assert(src_surface);
   assert(src_area);
   assert(dst_surface);
   assert(dst_area);
   assert(picture_type == PIPE_MPEG12_PICTURE_TYPE_FRAME);

   if (compositor->fb_state.width != dst_surface->width) {
      compositor->fb_inv_size.x = 1.0f / dst_surface->width;
      compositor->fb_state.width = dst_surface->width;
   }
   if (compositor->fb_state.height != dst_surface->height) {
      compositor->fb_inv_size.y = 1.0f / dst_surface->height;
      compositor->fb_state.height = dst_surface->height;
   }

   compositor->fb_state.cbufs[0] = dst_surface;

   compositor->viewport.scale[0] = compositor->fb_state.width;
   compositor->viewport.scale[1] = compositor->fb_state.height;
   compositor->viewport.scale[2] = 1;
   compositor->viewport.scale[3] = 1;
   compositor->viewport.translate[0] = 0;
   compositor->viewport.translate[1] = 0;
   compositor->viewport.translate[2] = 0;
   compositor->viewport.translate[3] = 0;

   samplers[0] = samplers[1] = compositor->sampler;

   compositor->pipe->set_framebuffer_state(compositor->pipe, &compositor->fb_state);
   compositor->pipe->set_viewport_state(compositor->pipe, &compositor->viewport);
   compositor->pipe->bind_fragment_sampler_states(compositor->pipe, 2, &samplers[0]);
   compositor->pipe->bind_vs_state(compositor->pipe, compositor->vertex_shader);
   compositor->pipe->set_vertex_buffers(compositor->pipe, 1, &compositor->vertex_buf);
   compositor->pipe->bind_vertex_elements_state(compositor->pipe, compositor->vertex_elems_state);
   compositor->pipe->set_constant_buffer(compositor->pipe, PIPE_SHADER_FRAGMENT, 0, compositor->fs_const_buf);

   draw_layers(compositor, src_surface, src_area, dst_area);

   assert(!compositor->dirty_layers);
   compositor->pipe->flush(compositor->pipe, fence);
}

void vl_compositor_set_csc_matrix(struct vl_compositor *compositor, const float *mat)
{
   struct pipe_transfer *buf_transfer;

   assert(compositor);

   memcpy
   (
      pipe_buffer_map(compositor->pipe, compositor->fs_const_buf,
                      PIPE_TRANSFER_WRITE | PIPE_TRANSFER_DISCARD,
                      &buf_transfer),
		mat,
		sizeof(struct fragment_shader_consts)
   );

   pipe_buffer_unmap(compositor->pipe, buf_transfer);
}