drivers/media/platform/coda/coda-h264.c

   1 /*
   2  * Coda multi-standard codec IP - H.264 helper functions
   3  *
   4  * Copyright (C) 2012 Vista Silicon S.L.
   5  *    Javier Martin, <javier.martin@vista-silicon.com>
   6  *    Xavier Duret
   7  *
   8  * This program is free software; you can redistribute it and/or modify
   9  * it under the terms of the GNU General Public License as published by
  10  * the Free Software Foundation; either version 2 of the License, or
  11  * (at your option) any later version.
  12  */
  13
  14 #include <linux/kernel.h>
  15 #include <linux/string.h>
  16
  17 static const u8 coda_filler_nal[14] = { 0x00, 0x00, 0x00, 0x01, 0x0c, 0xff,
  18                         0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x80 };
  19 static const u8 coda_filler_size[8] = { 0, 7, 14, 13, 12, 11, 10, 9 };
  20
  21 int coda_h264_padding(int size, char *p)
  22 {
  23         int nal_size;
  24         int diff;
  25
  26         diff = size - (size & ~0x7);
  27         if (diff == 0)
  28                 return 0;
  29
  30         nal_size = coda_filler_size[diff];
  31         memcpy(p, coda_filler_nal, nal_size);
  32
  33         /* Add rbsp stop bit and trailing at the end */
  34         *(p + nal_size - 1) = 0x80;
  35
  36         return nal_size;
  37 }