kolibrios/programs/media/Fplay/pixlib2.c

#include <stdio.h>
#include <pixlib2.h>
#include "system.h"


#define DISPLAY_VERSION     0x0200     /*      2.00     */

#define SRV_GETVERSION       0
#define SRV_GET_CAPS         3

#define SRV_CREATE_SURFACE  10
#define SRV_DESTROY_SURFACE     11
#define SRV_LOCK_SURFACE    12
#define SRV_UNLOCK_SURFACE      13
#define SRV_RESIZE_SURFACE      14
#define SRV_BLIT_BITMAP         15
#define SRV_BLIT_TEXTURE        16
#define SRV_BLIT_VIDEO          17


#define BUFFER_SIZE(n) ((n)*sizeof(uint32_t))
#define __ALIGN_MASK(x,mask)  (((x)+(mask))&~(mask))
#define ALIGN(x,a)            __ALIGN_MASK(x,(typeof(x))(a)-1)



static uint32_t service;
static uint32_t blit_caps;
static uint32_t screen_width;
static uint32_t screen_height;

typedef struct
{
  unsigned      handle;
  unsigned      io_code;
  void          *input;
  int           inp_size;
  void          *output;
  int           out_size;
}ioctl_t;



typedef struct
{
    uint32_t  idx;
    union
    {
        uint32_t opt[2];
        struct {
            uint32_t max_tex_width;
            uint32_t max_tex_height;
        }cap1;
    };
}hwcaps_t;

static inline uint32_t GetScreenSize()
{
     uint32_t retval;

     __asm__ __volatile__(
     "int $0x40"
     :"=a"(retval)
     :"a"(61), "b"(1));
     return retval;
}

static uint32_t get_service(char *name)
{
  uint32_t retval = 0;
  asm volatile ("int $0x40"
      :"=a"(retval)
      :"a"(68),"b"(16),"c"(name)
      :"memory");

  return retval;
};

static int call_service(ioctl_t *io)
{
  int retval;

  asm volatile("int $0x40"
      :"=a"(retval)
      :"a"(68),"b"(17),"c"(io)
      :"memory","cc");

  return retval;
};


uint32_t init_pixlib(uint32_t caps)
{
    uint32_t  api_version;
    uint32_t  screensize;
    hwcaps_t  hwcaps;
    ioctl_t   io;

 //   __asm__ __volatile__("int3");

    screensize    = GetScreenSize();
    screen_width  = screensize >> 16;
    screen_height = screensize & 0xFFFF;

    service = get_service("DISPLAY");
    if(service == 0)
        goto fail;

    io.handle   = service;
    io.io_code  = SRV_GETVERSION;
    io.input    = NULL;
    io.inp_size = 0;
    io.output   = &api_version;
    io.out_size = BUFFER_SIZE(1);

    if (call_service(&io)!=0)
        goto fail;

    if( (DISPLAY_VERSION > (api_version & 0xFFFF)) ||
        (DISPLAY_VERSION < (api_version >> 16)))
        goto fail;

/*
 * Let's see what this service can do
*/
    hwcaps.idx  = 0;

    io.handle   = service;
    io.io_code  = SRV_GET_CAPS;
    io.input    = &hwcaps;
    io.inp_size = sizeof(hwcaps);
    io.output   = NULL;
    io.out_size = 0;

    if (call_service(&io)!=0)
        goto fail;

    blit_caps = hwcaps.opt[0];

    printf("\nDISPLAY service handle %x\n", service);

    if( blit_caps )
        printf("service caps %s%s%s\n",
               (blit_caps & HW_BIT_BLIT) != 0 ?"HW_BIT_BLIT ":"",
               (blit_caps & HW_TEX_BLIT) != 0 ?"HW_TEX_BLIT ":"",
               (blit_caps & HW_VID_BLIT) != 0 ?"HW_VID_BLIT ":"");

    blit_caps&= caps;
    return blit_caps;

fail:
    service = 0;
    return 0;
};


int create_bitmap(bitmap_t *bitmap)
{
 //    __asm__ __volatile__("int3");

    if( bitmap->flags &&  blit_caps & HW_BIT_BLIT )
    {
        struct __attribute__((packed))  /*     SRV_CREATE_SURFACE    */
        {
            uint32_t  handle;           // ignored
            void      *data;            // ignored

            uint32_t  width;
            uint32_t  height;
            uint32_t  pitch;            // ignored

            uint32_t  max_width;
            uint32_t  max_height;
            uint32_t  format;           // reserved mbz
        }io_10;

        ioctl_t io;
        int     err;

//        printf("create bitmap %d x %d\n",
//                bitmap->width, bitmap->height);

        io_10.width      = bitmap->width;
        io_10.height     = bitmap->height;
        io_10.max_width  = screen_width;
        io_10.max_height = screen_height;
        io_10.format     = 0;

        io.handle   = service;
        io.io_code  = SRV_CREATE_SURFACE;
        io.input    = &io_10;
        io.inp_size = BUFFER_SIZE(8);
        io.output   = NULL;
        io.out_size = 0;

        err = call_service(&io);
        if(err==0)
        {
            bitmap->handle = io_10.handle;
            bitmap->pitch  = io_10.pitch;
            bitmap->data   = io_10.data;
//            printf("Create hardware surface %x pitch %d, buffer %x\n",
//                     bitmap->handle, bitmap->pitch, bitmap->data);
            return 0;
        };
    };

    uint32_t   size;
    uint32_t   pitch;
    uint8_t   *buffer;

    pitch = ALIGN(bitmap->width*4, 16);
    size  = pitch * bitmap->height;

    buffer = (uint8_t*)user_alloc(size);
    if( buffer )
    {
        bitmap->handle = 0;
        bitmap->pitch  = pitch;
        bitmap->data   = buffer;
        bitmap->flags  = 0;
        return 0;
    };

    printf("Cannot alloc frame buffer\n\r");

    return -1;
};

int lock_bitmap(bitmap_t *bitmap)
{
 //    __asm__ __volatile__("int3");
    int err = 0;

    if( bitmap->flags && blit_caps & HW_BIT_BLIT )
    {
        struct __attribute__((packed))  /*     SRV_LOCK_SURFACE    */
        {
            uint32_t  handle;
            void      *data;
            uint32_t  pitch;

        }io_12;

        ioctl_t io;

        io_12.handle  = bitmap->handle;
        io_12.pitch   = 0;
        io_12.data    = 0;

        io.handle   = service;
        io.io_code  = SRV_LOCK_SURFACE;
        io.input    = &io_12;
        io.inp_size = BUFFER_SIZE(3);
        io.output   = NULL;
        io.out_size = 0;

        err = call_service(&io);
        if(err==0)
        {
            bitmap->pitch  = io_12.pitch;
            bitmap->data   = io_12.data;
//            printf("Lock hardware surface %x pitch %d, buffer %x\n",
//                     bitmap->handle, bitmap->pitch, bitmap->data);
        };
    };

    return err;
};

int blit_bitmap(bitmap_t *bitmap, int dst_x, int dst_y,
                int w, int h)
{
    int err;

    if( bitmap->flags && blit_caps & HW_BIT_BLIT )
    {

/*
 *   Now you will experience the full power of the dark side...
*/

        struct __attribute__((packed))
        {
            uint32_t handle;
            int      dst_x;
            int      dst_y;
            int      src_x;
            int      src_y;
            uint32_t w;
            uint32_t h;
        }io_15;

        ioctl_t io;

        io_15.handle = bitmap->handle;
        io_15.dst_x  = dst_x;
        io_15.dst_y  = dst_y;
        io_15.src_x  = 0;
        io_15.src_y  = 0;
        io_15.w      = w;
        io_15.h      = h;

        io.handle    = service;
        io.io_code   = SRV_BLIT_BITMAP;
        io.input     = &io_15;
        io.inp_size  = BUFFER_SIZE(7);
        io.output    = NULL;
        io.out_size  = 0;

//        printf("do blit %x pitch %d\n",bitmap->handle,
//                bitmap->pitch);
        err = call_service(&io);
        return err;
    };

    struct blit_call bc;

    bc.dstx = dst_x;
    bc.dsty = dst_y;
    bc.w    = w;
    bc.h    = h;
    bc.srcx = 0;
    bc.srcy = 0;
    bc.srcw = w;
    bc.srch = h;
    bc.stride = bitmap->pitch;
    bc.bitmap = bitmap->data;

    __asm__ __volatile__(
    "int $0x40"
    :"=a"(err)
    :"a"(73),"b"(0x00),"c"(&bc)
    :"memory");
    
    return err;
};

int resize_bitmap(bitmap_t *bitmap)
{
 //    __asm__ __volatile__("int3");

    if( bitmap->flags && blit_caps & HW_BIT_BLIT )
    {
        struct __attribute__((packed))
        {
            uint32_t  handle;
            char     *data;
            uint32_t  new_w;
            uint32_t  new_h;
            uint32_t  pitch;
        }io_14;

        ioctl_t io;
        int     err;

        io_14.handle = bitmap->handle;
        io_14.new_w  = bitmap->width;
        io_14.new_h  = bitmap->height;

        io.handle    = service;
        io.io_code   = SRV_RESIZE_SURFACE;
        io.input     = &io_14;
        io.inp_size  = BUFFER_SIZE(5);
        io.output    = NULL;
        io.out_size  = 0;

        err = call_service(&io);
        if(err==0)
    {
            bitmap->pitch  = io_14.pitch;
            bitmap->data   = io_14.data;
        };
        return err;
    };

    uint32_t   size;
    uint32_t   pitch;
    uint8_t   *buffer;

    pitch = ALIGN(bitmap->width*4, 16);
    size  = pitch * bitmap->height;

    buffer = (uint8_t*)user_realloc(bitmap->data, size);
    if( buffer )
    {
        bitmap->handle = 0;
        bitmap->pitch  = pitch;
        bitmap->data   = buffer;
        return 0;
    };

    printf("Cannot realloc frame buffer\n\r");

    return -1;
};