WebSVN – Kolibri OS – Diff – /drivers/video/drm/i915/kms_display.c


#define iowrite32(v, addr)      writel((v), (addr))
 
#include "drmP.h"
#include "drm.h"
#include "i915_drm.h"
#include "i915_drv.h"
#include "intel_drv.h"
 
#include 
#include 
#include 
#include 
#include 
 
#include 
 
#include "bitmap.h"
 
typedef struct
{
    kobj_t     header;
 
    uint32_t  *data;
    uint32_t   hot_x;
    uint32_t   hot_y;
 
    struct list_head   list;
    struct drm_i915_gem_object  *cobj;
}cursor_t;
 
#define CURSOR_WIDTH 64
#define CURSOR_HEIGHT 64
 
 
struct tag_display
{
    int  x;
    int  y;
    int  width;
    int  height;
    int  bpp;
    int  vrefresh;
    int  pitch;
    int  lfb;
 
    int  supported_modes;
    struct drm_device    *ddev;
    struct drm_connector *connector;
    struct drm_crtc      *crtc;
 
    struct list_head   cursors;
 
    cursor_t   *cursor;
    int       (*init_cursor)(cursor_t*);
    cursor_t* (__stdcall *select_cursor)(cursor_t*);
    void      (*show_cursor)(int show);
    void      (__stdcall *move_cursor)(cursor_t *cursor, int x, int y);
    void      (__stdcall *restore_cursor)(int x, int y);
    void      (*disable_mouse)(void);
    u32  mask_seqno;
    u32  check_mouse;
    u32  check_m_pixel;
 
};
 
 
static display_t *os_display;
 
u32_t cmd_buffer;
u32_t cmd_offset;
 
void init_render();
int  sna_init();
 
int init_cursor(cursor_t *cursor);
static cursor_t*  __stdcall select_cursor_kms(cursor_t *cursor);
static void       __stdcall move_cursor_kms(cursor_t *cursor, int x, int y);
 
void __stdcall restore_cursor(int x, int y)
{};
 
void disable_mouse(void)
{};
 
static char *manufacturer_name(unsigned char *x)
{
    static char name[4];
 
    name[0] = ((x[0] & 0x7C) >> 2) + '@';
    name[1] = ((x[0] & 0x03) << 3) + ((x[1] & 0xE0) >> 5) + '@';
    name[2] = (x[1] & 0x1F) + '@';
    name[3] = 0;
 
    return name;
}
 
bool set_mode(struct drm_device *dev, struct drm_connector *connector,
              videomode_t *reqmode, bool strict)
{
    drm_i915_private_t      *dev_priv   = dev->dev_private;
    struct drm_fb_helper    *fb_helper  = &dev_priv->fbdev->helper;
 
    struct drm_mode_config  *config     = &dev->mode_config;
    struct drm_display_mode *mode       = NULL, *tmpmode;
    struct drm_framebuffer  *fb         = NULL;
    struct drm_crtc         *crtc;
    struct drm_encoder      *encoder;
    struct drm_i915_gem_object *fb_obj;
    struct drm_mode_set     set;
    char *con_name;
    char *enc_name;
    unsigned hdisplay, vdisplay;
    int ret;
 
    mutex_lock(&dev->mode_config.mutex);
 
    list_for_each_entry(tmpmode, &connector->modes, head)
    {
        if( (drm_mode_width(tmpmode)    == reqmode->width)  &&
            (drm_mode_height(tmpmode)   == reqmode->height) &&
            (drm_mode_vrefresh(tmpmode) == reqmode->freq) )
        {
            mode = tmpmode;
            goto do_set;
        }
    };
 
    if( (mode == NULL) && (strict == false) )
    {
        list_for_each_entry(tmpmode, &connector->modes, head)
        {
            if( (drm_mode_width(tmpmode)  == reqmode->width)  &&
                (drm_mode_height(tmpmode) == reqmode->height) )
            {
                mode = tmpmode;
                goto do_set;
            }
        };
    };
 
    DRM_ERROR("%s failed\n", __FUNCTION__);
 
    return -1;
 
do_set:
 
    encoder = connector->encoder;
    crtc = encoder->crtc;
 
    con_name = drm_get_connector_name(connector);
    enc_name = drm_get_encoder_name(encoder);
 
    DRM_DEBUG_KMS("set mode %d %d: crtc %d connector %s encoder %s\n",
              reqmode->width, reqmode->height, crtc->base.id,
              con_name, enc_name);
 
    drm_mode_set_crtcinfo(mode, CRTC_INTERLACE_HALVE_V);
 
    hdisplay = mode->hdisplay;
    vdisplay = mode->vdisplay;
 
    if (crtc->invert_dimensions)
        swap(hdisplay, vdisplay);
 
    fb_obj = get_fb_obj();
    fb = fb_helper->fb;
 
    fb->width  = reqmode->width;
    fb->height = reqmode->height;
 
    fb->pitches[0]  = fb->pitches[1]  = fb->pitches[2]  =
                      fb->pitches[3]  = ALIGN(reqmode->width * 4, 512);
 
 
    fb_obj->stride = fb->pitches[0];
 
    fb->bits_per_pixel = 32;
    fb->depth = 24;
 
    crtc->fb = fb;
    crtc->enabled = true;
    os_display->crtc = crtc;
 
    i915_gem_object_put_fence(fb_obj);
 
    set.crtc = crtc;
    set.x = 0;
    set.y = 0;
    set.mode = mode;
    set.connectors = &connector;
    set.num_connectors = 1;
    set.fb = fb;
    ret = crtc->funcs->set_config(&set);
    mutex_unlock(&dev->mode_config.mutex);
 
    if ( !ret )
    {
        os_display->width    = fb->width;
        os_display->height   = fb->height;
        os_display->pitch    = fb->pitches[0];
        os_display->vrefresh = drm_mode_vrefresh(mode);
 
        sysSetScreen(fb->width, fb->height, fb->pitches[0]);
 
        DRM_DEBUG_KMS("new mode %d x %d pitch %d\n",
                       fb->width, fb->height, fb->pitches[0]);
    }
    else
        DRM_ERROR("failed to set mode %d_%d on crtc %p\n",
                   fb->width, fb->height, crtc);
 
 
    return ret;
}
 
static int count_connector_modes(struct drm_connector* connector)
{
    struct drm_display_mode  *mode;
    int count = 0;
 
    list_for_each_entry(mode, &connector->modes, head)
    {
        count++;
    };
    return count;
};
 
static struct drm_connector* get_def_connector(struct drm_device *dev)
{
    struct drm_connector  *connector;
    struct drm_connector_helper_funcs *connector_funcs;
 
    struct drm_connector  *def_connector = NULL;
 
    list_for_each_entry(connector, &dev->mode_config.connector_list, head)
    {
        struct drm_encoder  *encoder;
        struct drm_crtc     *crtc;
 
        if( connector->status != connector_status_connected)
            continue;
 
        connector_funcs = connector->helper_private;
        encoder = connector_funcs->best_encoder(connector);
        if( encoder == NULL)
            continue;
 
        connector->encoder = encoder;
 
        crtc = encoder->crtc;
 
        DRM_DEBUG_KMS("CONNECTOR %x ID:  %d status %d encoder %x\n crtc %x",
                   connector, connector->base.id,
                   connector->status, connector->encoder,
                   crtc);
 
//        if (crtc == NULL)
//            continue;
 
        def_connector = connector;
 
        break;
    };
 
    return def_connector;
};
 
 
int init_display_kms(struct drm_device *dev, videomode_t *usermode)
{
    struct drm_connector    *connector;
    struct drm_connector_helper_funcs *connector_funcs;
    struct drm_encoder      *encoder;
    struct drm_crtc         *crtc = NULL;
    struct drm_framebuffer  *fb;
 
    cursor_t  *cursor;
    u32_t      ifl;
    int        err;
 
    ENTER();
 
    mutex_lock(&dev->mode_config.mutex);
 
    list_for_each_entry(connector, &dev->mode_config.connector_list, head)
    {
        if( connector->status != connector_status_connected)
            continue;
 
        connector_funcs = connector->helper_private;
        encoder = connector_funcs->best_encoder(connector);
        if( encoder == NULL)
        {
            DRM_DEBUG_KMS("CONNECTOR %x ID: %d no active encoders\n",
                      connector, connector->base.id);
            continue;
        }
        connector->encoder = encoder;
        crtc = encoder->crtc;
 
        DRM_DEBUG_KMS("CONNECTOR %p ID:%d status:%d ENCODER %x CRTC %p ID:%d\n",
               connector, connector->base.id,
               connector->status, connector->encoder,
               crtc, crtc->base.id );
        break;
 
    };
 
    if(connector == NULL)
    {
        DRM_DEBUG_KMS("No active connectors!\n");
        mutex_unlock(&dev->mode_config.mutex);
        return -1;
    };
 
    dbgprintf("CRTC %p\n", crtc);
 
    if(crtc == NULL)
    {
        struct drm_crtc *tmp_crtc;
        int crtc_mask = 1;
 
        list_for_each_entry(tmp_crtc, &dev->mode_config.crtc_list, head)
        {
            dbgprintf("tmp_crtc %p\n", tmp_crtc);
            if (encoder->possible_crtcs & crtc_mask)
            {
                crtc = tmp_crtc;
                encoder->crtc = crtc;
                dbgprintf("CRTC %p\n", crtc);
                break;
            };
            crtc_mask <<= 1;
        };
    };
 
    dbgprintf("CRTC %p\n", crtc);
 
    if(crtc == NULL)
    {
        DRM_DEBUG_KMS("No CRTC for encoder %d\n", encoder->base.id);
        mutex_unlock(&dev->mode_config.mutex);
        return -1;
    };
 
 
    DRM_DEBUG_KMS("[Select CRTC: %p ID:%d]\n",crtc, crtc->base.id);
 
    os_display = GetDisplay();
    os_display->ddev = dev;
    os_display->connector = connector;
    os_display->crtc = crtc;
 
    os_display->supported_modes = count_connector_modes(connector);
 
 
    ifl = safe_cli();
    {
        struct intel_crtc *intel_crtc = to_intel_crtc(os_display->crtc);
 
        list_for_each_entry(cursor, &os_display->cursors, list)
        {
            init_cursor(cursor);
        };
 
        os_display->restore_cursor(0,0);
        os_display->init_cursor    = init_cursor;
        os_display->select_cursor  = select_cursor_kms;
        os_display->show_cursor    = NULL;
        os_display->move_cursor    = move_cursor_kms;
        os_display->restore_cursor = restore_cursor;
        os_display->disable_mouse  = disable_mouse;
 
        intel_crtc->cursor_x = os_display->width/2;
        intel_crtc->cursor_y = os_display->height/2;
 
        select_cursor_kms(os_display->cursor);
    };
    safe_sti(ifl);
 
    if( (usermode->width == 0) ||
        (usermode->height == 0))
    {
        struct drm_display_mode *mode;
 
//        connector->funcs->fill_modes(connector, dev->mode_config.max_width,
//                                     dev->mode_config.max_height);
 
        list_for_each_entry(mode, &connector->modes, head)
        {
            printf("check mode w:%d h:%d %dHz\n",
                    drm_mode_width(mode), drm_mode_height(mode),
                    drm_mode_vrefresh(mode));
 
            if( os_display->width  == drm_mode_width(mode)  &&
                os_display->height == drm_mode_height(mode) &&
                drm_mode_vrefresh(mode) == 60)
            {
                usermode->width  = os_display->width;
                usermode->height = os_display->height;
                usermode->freq   = 60;
                break;
 
            }
        }
 
        if( usermode->width  == 0 ||
            usermode->height == 0)
        {
            mode = list_entry(connector->modes.next, typeof(*mode), head);
 
            usermode->width  = drm_mode_width(mode);
            usermode->height = drm_mode_height(mode);
            usermode->freq   = drm_mode_vrefresh(mode);
        };
    };
 
    mutex_unlock(&dev->mode_config.mutex);
 
    set_mode(dev, os_display->connector, usermode, false);
 
#ifdef __HWA__
    err = init_bitmaps();
#endif
 
    LEAVE();
 
    return 0;
};
 
 
int get_videomodes(videomode_t *mode, int *count)
{
    int err = -1;
 
//    dbgprintf("mode %x count %d\n", mode, *count);
 
    if( *count == 0 )
    {
        *count = os_display->supported_modes;
        err = 0;
    }
    else if( mode != NULL )
    {
        struct drm_display_mode  *drmmode;
        int i = 0;
 
        if( *count > os_display->supported_modes)
            *count = os_display->supported_modes;
 
        list_for_each_entry(drmmode, &os_display->connector->modes, head)
        {
            if( i < *count)
            {
                mode->width  = drm_mode_width(drmmode);
                mode->height = drm_mode_height(drmmode);
                mode->bpp    = 32;
                mode->freq   = drm_mode_vrefresh(drmmode);
                i++;
                mode++;
            }
            else break;
        };
        *count = i;
        err = 0;
    };
    return err;
};
 
int set_user_mode(videomode_t *mode)
{
    int err = -1;
 
//    dbgprintf("width %d height %d vrefresh %d\n",
//               mode->width, mode->height, mode->freq);
 
    if( (mode->width  != 0)  &&
        (mode->height != 0)  &&
        (mode->freq   != 0 ) &&
        ( (mode->width   != os_display->width)  ||
          (mode->height  != os_display->height) ||
          (mode->freq    != os_display->vrefresh) ) )
    {
        if( set_mode(os_display->ddev, os_display->connector, mode, true) )
            err = 0;
    };
 
    return err;
};
 
void i915_dpms(struct drm_device *dev, int mode)
{
    struct drm_connector_funcs *f = os_display->connector->funcs;
 
    f->dpms(os_display->connector, mode);
};
 
void __attribute__((regparm(1))) destroy_cursor(cursor_t *cursor)
{
    list_del(&cursor->list);
 
    i915_gem_object_unpin(cursor->cobj);
 
    mutex_lock(&main_device->struct_mutex);
    drm_gem_object_unreference(&cursor->cobj->base);
    mutex_unlock(&main_device->struct_mutex);
 
    __DestroyObject(cursor);
};
 
int init_cursor(cursor_t *cursor)
{
    struct drm_i915_private *dev_priv = os_display->ddev->dev_private;
    struct drm_i915_gem_object *obj;
    uint32_t *bits;
    uint32_t *src;
    void     *mapped;
 
    int       i,j;
    int       ret;
 
    if (dev_priv->info->cursor_needs_physical)
    {
        bits = (uint32_t*)KernelAlloc(CURSOR_WIDTH*CURSOR_HEIGHT*4);
        if (unlikely(bits == NULL))
            return ENOMEM;
        cursor->cobj = (struct drm_i915_gem_object *)GetPgAddr(bits);
    }
    else
    {
        obj = i915_gem_alloc_object(os_display->ddev, CURSOR_WIDTH*CURSOR_HEIGHT*4);
        if (unlikely(obj == NULL))
            return -ENOMEM;
 
        ret = i915_gem_obj_ggtt_pin(obj, CURSOR_WIDTH*CURSOR_HEIGHT*4, true, true);
        if (ret) {
            drm_gem_object_unreference(&obj->base);
            return ret;
        }
 
        ret = i915_gem_object_set_to_gtt_domain(obj, true);
        if (ret)
        {
            i915_gem_object_unpin(obj);
            drm_gem_object_unreference(&obj->base);
            return ret;
        }
/* You don't need to worry about fragmentation issues.
 * GTT space is continuous. I guarantee it.                           */
 
        mapped = bits = (u32*)MapIoMem(dev_priv->gtt.mappable_base + i915_gem_obj_ggtt_offset(obj),
                    CURSOR_WIDTH*CURSOR_HEIGHT*4, PG_SW);
 
        if (unlikely(bits == NULL))
        {
            i915_gem_object_unpin(obj);
            drm_gem_object_unreference(&obj->base);
            return -ENOMEM;
        };
        cursor->cobj = obj;
    };
 
    src = cursor->data;
 
    for(i = 0; i < 32; i++)
    {
        for(j = 0; j < 32; j++)
            *bits++ = *src++;
        for(j = 32; j < CURSOR_WIDTH; j++)
            *bits++ = 0;
    }
    for(i = 0; i < CURSOR_WIDTH*(CURSOR_HEIGHT-32); i++)
        *bits++ = 0;
 
    FreeKernelSpace(mapped);
 
// release old cursor
 
    KernelFree(cursor->data);
 
    cursor->data = bits;
 
    cursor->header.destroy = destroy_cursor;
 
    return 0;
}
 
 
static void i9xx_update_cursor(struct drm_crtc *crtc, u32 base)
{
    struct drm_device *dev = crtc->dev;
    struct drm_i915_private *dev_priv = dev->dev_private;
    struct intel_crtc *intel_crtc = to_intel_crtc(crtc);
    int pipe = intel_crtc->pipe;
    bool visible = base != 0;
 
    if (intel_crtc->cursor_visible != visible) {
        uint32_t cntl = I915_READ(CURCNTR(pipe));
        if (base) {
            cntl &= ~(CURSOR_MODE | MCURSOR_PIPE_SELECT);
            cntl |= CURSOR_MODE_64_ARGB_AX | MCURSOR_GAMMA_ENABLE;
            cntl |= pipe << 28; /* Connect to correct pipe */
        } else {
            cntl &= ~(CURSOR_MODE | MCURSOR_GAMMA_ENABLE);
            cntl |= CURSOR_MODE_DISABLE;
        }
        I915_WRITE(CURCNTR(pipe), cntl);
 
        intel_crtc->cursor_visible = visible;
    }
    /* and commit changes on next vblank */
    I915_WRITE(CURBASE(pipe), base);
}
 
void __stdcall move_cursor_kms(cursor_t *cursor, int x, int y)
{
    struct drm_i915_private *dev_priv = os_display->ddev->dev_private;
    struct intel_crtc *intel_crtc = to_intel_crtc(os_display->crtc);
    u32 base, pos;
    bool visible;
 
    int pipe = intel_crtc->pipe;
 
    intel_crtc->cursor_x = x;
    intel_crtc->cursor_y = y;
 
    x = x - cursor->hot_x;
    y = y - cursor->hot_y;
 
 
    pos = 0;
 
    base = intel_crtc->cursor_addr;
    if (x >= os_display->width)
        base = 0;
 
    if (y >= os_display->height)
        base = 0;
 
    if (x < 0)
    {
        if (x + intel_crtc->cursor_width < 0)
            base = 0;
 
        pos |= CURSOR_POS_SIGN << CURSOR_X_SHIFT;
        x = -x;
    }
    pos |= x << CURSOR_X_SHIFT;
 
    if (y < 0)
    {
        if (y + intel_crtc->cursor_height < 0)
            base = 0;
 
        pos |= CURSOR_POS_SIGN << CURSOR_Y_SHIFT;
        y = -y;
    }
    pos |= y << CURSOR_Y_SHIFT;
 
    visible = base != 0;
    if (!visible && !intel_crtc->cursor_visible)
        return;
 
    I915_WRITE(CURPOS(pipe), pos);
//    if (IS_845G(dev) || IS_I865G(dev))
//        i845_update_cursor(crtc, base);
//    else
        i9xx_update_cursor(os_display->crtc, base);
 
};
 
 
cursor_t* __stdcall select_cursor_kms(cursor_t *cursor)
{
    struct drm_i915_private *dev_priv = os_display->ddev->dev_private;
    struct intel_crtc *intel_crtc = to_intel_crtc(os_display->crtc);
    cursor_t *old;
 
    old = os_display->cursor;
    os_display->cursor = cursor;
 
    if (!dev_priv->info->cursor_needs_physical)
       intel_crtc->cursor_addr = i915_gem_obj_ggtt_offset(cursor->cobj);
    else
        intel_crtc->cursor_addr = (addr_t)cursor->cobj;
 
    intel_crtc->cursor_width = 32;
    intel_crtc->cursor_height = 32;
 
    move_cursor_kms(cursor, intel_crtc->cursor_x, intel_crtc->cursor_y);
    return old;
};
 
struct sna_fb
{
    uint32_t  width;
    uint32_t  height;
    uint32_t  pitch;
    uint32_t  tiling;
};
 
int i915_fbinfo(struct sna_fb *fb)
{
    fb->width  = os_display->width;
    fb->height = os_display->height;
    fb->pitch  = os_display->pitch;
    fb->tiling = 0;
 
    return 0;
};
 
typedef struct
{
    int left;
    int top;
    int right;
    int bottom;
}rect_t;
 
struct drm_i915_mask {
    __u32 handle;
    __u32 width;
    __u32 height;
    __u32 bo_size;
    __u32 bo_pitch;
    __u32 bo_map;
};
 
#define CURRENT_TASK             (0x80003000)
 
static u32_t get_display_map()
{
    u32_t   addr;
 
    addr = (u32_t)os_display;
    addr+= sizeof(display_t);            /*  shoot me  */
    return *(u32_t*)addr;
}
 
void  FASTCALL GetWindowRect(rect_t *rc)__asm__("GetWindowRect");
 
int i915_mask_update(struct drm_device *dev, void *data,
            struct drm_file *file)
{
    struct drm_i915_mask *mask = data;
    struct drm_gem_object *obj;
    static unsigned int mask_seqno[256];
    rect_t winrc;
    u32    slot;
    int    ret;
 
     if(mask->handle == -2)
     {
        printf("%s handle %d\n", __FUNCTION__, mask->handle);
        return 0;
     }
 
    obj = drm_gem_object_lookup(dev, file, mask->handle);
    if (obj == NULL)
        return -ENOENT;
 
    if (!obj->filp) {
        drm_gem_object_unreference_unlocked(obj);
        return -EINVAL;
    }
 
    GetWindowRect(&winrc);
    {
//        static warn_count;
 
        mask->width    = winrc.right - winrc.left + 1;
        mask->height   = winrc.bottom - winrc.top + 1;
        mask->bo_pitch = (mask->width+15) & ~15;
 
#if 0
        if(warn_count < 1)
        {
            printf("left %d top %d right %d bottom %d\n",
                    winrc.left, winrc.top, winrc.right, winrc.bottom);
            printf("mask pitch %d data %p\n", mask->bo_pitch, mask->bo_size);
            warn_count++;
        };
#endif
 
     };
 
 
    slot = *((u8*)CURRENT_TASK);
 
    if( mask_seqno[slot] != os_display->mask_seqno)
    {
        u8* src_offset;
        u8* dst_offset;
        u32 ifl;
 
        ret = i915_mutex_lock_interruptible(dev);
        if (ret)
            return ret;
 
        ret = i915_gem_object_set_to_cpu_domain(to_intel_bo(obj), true);
        if(ret !=0 )
        {
            dbgprintf("%s fail\n", __FUNCTION__);
            return ret;
        };
 
//        printf("width %d height %d\n", winrc.right, winrc.bottom);
 
//        slot = 0x01;
 
 
        src_offset = (u8*)( winrc.top*os_display->width + winrc.left);
        src_offset+= get_display_map();
        dst_offset = (u8*)mask->bo_map;
 
        u32_t tmp_h = mask->height;
 
        ifl = safe_cli();
        {
            mask_seqno[slot] = os_display->mask_seqno;
 
            slot|= (slot<<8)|(slot<<16)|(slot<<24);
 
            __asm__ __volatile__ (
                "movd       %[slot],   %%xmm6    \n"
            "punpckldq  %%xmm6, %%xmm6            \n"
            "punpcklqdq %%xmm6, %%xmm6            \n"
            :: [slot]  "m" (slot)
            :"xmm6");
 
            while( tmp_h--)
            {
                int tmp_w = mask->bo_pitch;
 
                u8* tmp_src = src_offset;
                u8* tmp_dst = dst_offset;
 
                src_offset+= os_display->width;
                dst_offset+= mask->bo_pitch;
 
                while(tmp_w >= 64)
                {
                    __asm__ __volatile__ (
                    "movdqu     (%0),   %%xmm0            \n"
                    "movdqu   16(%0),   %%xmm1            \n"
                    "movdqu   32(%0),   %%xmm2            \n"
                    "movdqu   48(%0),   %%xmm3            \n"
                    "pcmpeqb    %%xmm6, %%xmm0            \n"
                    "pcmpeqb    %%xmm6, %%xmm1            \n"
                    "pcmpeqb    %%xmm6, %%xmm2            \n"
                    "pcmpeqb    %%xmm6, %%xmm3            \n"
                    "movdqa     %%xmm0,   (%%edi)         \n"
                    "movdqa     %%xmm1, 16(%%edi)         \n"
                    "movdqa     %%xmm2, 32(%%edi)         \n"
                    "movdqa     %%xmm3, 48(%%edi)         \n"
 
                    :: "r" (tmp_src), "D" (tmp_dst)
                    :"xmm0","xmm1","xmm2","xmm3");
                    tmp_w -= 64;
                    tmp_src += 64;
                    tmp_dst += 64;
                }
 
                if( tmp_w >= 32 )
                {
                    __asm__ __volatile__ (
                    "movdqu     (%0),   %%xmm0            \n"
                    "movdqu   16(%0),   %%xmm1            \n"
                    "pcmpeqb    %%xmm6, %%xmm0            \n"
                    "pcmpeqb    %%xmm6, %%xmm1            \n"
                    "movdqa     %%xmm0,   (%%edi)         \n"
                    "movdqa     %%xmm1, 16(%%edi)         \n"
 
                    :: "r" (tmp_src), "D" (tmp_dst)
                    :"xmm0","xmm1");
                    tmp_w -= 32;
                    tmp_src += 32;
                    tmp_dst += 32;
                }
 
                while( tmp_w > 0 )
                {
                    __asm__ __volatile__ (
                    "movdqu     (%0),   %%xmm0            \n"
                    "pcmpeqb    %%xmm6, %%xmm0            \n"
                    "movdqa     %%xmm0,   (%%edi)         \n"
                    :: "r" (tmp_src), "D" (tmp_dst)
                    :"xmm0");
                    tmp_w -= 16;
                    tmp_src += 16;
                    tmp_dst += 16;
                }
            };
        };
        safe_sti(ifl);
    }
 
    drm_gem_object_unreference(obj);
 
    mutex_unlock(&dev->struct_mutex);
 
    return 0;
}
 
 
 
 
 
 
 
 
 
 
 
 
#define NSEC_PER_SEC    1000000000L
 
void getrawmonotonic(struct timespec *ts)
{
    u32 tmp = GetTimerTicks();
 
    ts->tv_sec  = tmp/100;
    ts->tv_nsec = (tmp - ts->tv_sec*100)*10000000;
}
 
void set_normalized_timespec(struct timespec *ts, time_t sec, s64 nsec)
{
    while (nsec >= NSEC_PER_SEC) {
        /*
         * The following asm() prevents the compiler from
         * optimising this loop into a modulo operation. See
         * also __iter_div_u64_rem() in include/linux/time.h
         */
        asm("" : "+rm"(nsec));
        nsec -= NSEC_PER_SEC;
        ++sec;
    }
    while (nsec < 0) {
        asm("" : "+rm"(nsec));
        nsec += NSEC_PER_SEC;
        --sec;
    }
    ts->tv_sec = sec;
    ts->tv_nsec = nsec;
}
 
void
prepare_to_wait(wait_queue_head_t *q, wait_queue_t *wait, int state)
{
    unsigned long flags;
 
//    wait->flags &= ~WQ_FLAG_EXCLUSIVE;
    spin_lock_irqsave(&q->lock, flags);
    if (list_empty(&wait->task_list))
            __add_wait_queue(q, wait);
    spin_unlock_irqrestore(&q->lock, flags);
}
 
/**
 * finish_wait - clean up after waiting in a queue
 * @q: waitqueue waited on
 * @wait: wait descriptor
 *
 * Sets current thread back to running state and removes
 * the wait descriptor from the given waitqueue if still
 * queued.
 */
void finish_wait(wait_queue_head_t *q, wait_queue_t *wait)
{
    unsigned long flags;
 
//    __set_current_state(TASK_RUNNING);
    /*
     * We can check for list emptiness outside the lock
     * IFF:
     *  - we use the "careful" check that verifies both
     *    the next and prev pointers, so that there cannot
     *    be any half-pending updates in progress on other
     *    CPU's that we haven't seen yet (and that might
     *    still change the stack area.
     * and
     *  - all other users take the lock (ie we can only
     *    have _one_ other CPU that looks at or modifies
     *    the list).
     */
    if (!list_empty_careful(&wait->task_list)) {
            spin_lock_irqsave(&q->lock, flags);
            list_del_init(&wait->task_list);
            spin_unlock_irqrestore(&q->lock, flags);
    }
 
    DestroyEvent(wait->evnt);
}
 
int autoremove_wake_function(wait_queue_t *wait, unsigned mode, int sync, void *key)
{
    list_del_init(&wait->task_list);
    return 1;
}
 
unsigned int hweight16(unsigned int w)
{
    unsigned int res = w - ((w >> 1) & 0x5555);
    res = (res & 0x3333) + ((res >> 2) & 0x3333);
    res = (res + (res >> 4)) & 0x0F0F;
    return (res + (res >> 8)) & 0x00FF;
}
 
 
unsigned long round_jiffies_up_relative(unsigned long j)
{
    unsigned long j0 = GetTimerTicks();
 
        /* Use j0 because jiffies might change while we run */
    return round_jiffies_common(j + j0, true) - j0;
}
 
>
 
>
 
>
 
>
 
>
 
>

Rev 4126	Rev 4280
1	#define iowrite32(v, addr) writel((v), (addr))	1	#define iowrite32(v, addr) writel((v), (addr))
2		2
3	#include "drmP.h"	3	#include "drmP.h"
4	#include "drm.h"	4	#include "drm.h"
5	#include "i915_drm.h"	5	#include "i915_drm.h"
6	#include "i915_drv.h"	6	#include "i915_drv.h"
7	#include "intel_drv.h"	7	#include "intel_drv.h"
8		8
9	#include	9	#include
10	#include	10	#include
11	#include	11	#include
12	#include	12	#include
13	#include	13	#include
14		14
15	#include	15	#include
16		16
17	#include "bitmap.h"	17	#include "bitmap.h"
18		18
19	typedef struct	19	typedef struct
20	{	20	{
21	kobj_t header;	21	kobj_t header;
22		22
23	uint32_t *data;	23	uint32_t *data;
24	uint32_t hot_x;	24	uint32_t hot_x;
25	uint32_t hot_y;	25	uint32_t hot_y;
26		26
27	struct list_head list;	27	struct list_head list;
28	struct drm_i915_gem_object *cobj;	28	struct drm_i915_gem_object *cobj;
29	}cursor_t;	29	}cursor_t;
30		30
31	#define CURSOR_WIDTH 64	31	#define CURSOR_WIDTH 64
32	#define CURSOR_HEIGHT 64	32	#define CURSOR_HEIGHT 64
33		33
34		34
35	struct tag_display	35	struct tag_display
36	{	36	{
37	int x;	37	int x;
38	int y;	38	int y;
39	int width;	39	int width;
40	int height;	40	int height;
41	int bpp;	41	int bpp;
42	int vrefresh;	42	int vrefresh;
43	int pitch;	43	int pitch;
44	int lfb;	44	int lfb;
45		45
46	int supported_modes;	46	int supported_modes;
47	struct drm_device *ddev;	47	struct drm_device *ddev;
48	struct drm_connector *connector;	48	struct drm_connector *connector;
49	struct drm_crtc *crtc;	49	struct drm_crtc *crtc;
50		50
51	struct list_head cursors;	51	struct list_head cursors;
52		52
53	cursor_t *cursor;	53	cursor_t *cursor;
54	int (init_cursor)(cursor_t);	54	int (init_cursor)(cursor_t);
55	cursor_t* (__stdcall select_cursor)(cursor_t);	55	cursor_t* (__stdcall select_cursor)(cursor_t);
56	void (*show_cursor)(int show);	56	void (*show_cursor)(int show);
57	void (__stdcall move_cursor)(cursor_t cursor, int x, int y);	57	void (__stdcall move_cursor)(cursor_t cursor, int x, int y);
58	void (__stdcall *restore_cursor)(int x, int y);	58	void (__stdcall *restore_cursor)(int x, int y);
59	void (*disable_mouse)(void);	59	void (*disable_mouse)(void);
60	u32 mask_seqno;	60	u32 mask_seqno;
61	u32 check_mouse;	61	u32 check_mouse;
62	u32 check_m_pixel;	62	u32 check_m_pixel;
63		63
64	};	64	};
65		65
66		66
67	static display_t *os_display;	67	static display_t *os_display;
68		68
69	u32_t cmd_buffer;	69	u32_t cmd_buffer;
70	u32_t cmd_offset;	70	u32_t cmd_offset;
71		71
72	void init_render();	72	void init_render();
73	int sna_init();	73	int sna_init();
74		74
75	int init_cursor(cursor_t *cursor);	75	int init_cursor(cursor_t *cursor);
76	static cursor_t* __stdcall select_cursor_kms(cursor_t *cursor);	76	static cursor_t* __stdcall select_cursor_kms(cursor_t *cursor);
77	static void __stdcall move_cursor_kms(cursor_t *cursor, int x, int y);	77	static void __stdcall move_cursor_kms(cursor_t *cursor, int x, int y);
78		78
79	void __stdcall restore_cursor(int x, int y)	79	void __stdcall restore_cursor(int x, int y)
80	{};	80	{};
81		81
82	void disable_mouse(void)	82	void disable_mouse(void)
83	{};	83	{};
84		84
85	static char manufacturer_name(unsigned char x)	85	static char manufacturer_name(unsigned char x)
86	{	86	{
87	static char name[4];	87	static char name[4];
88		88
89	name[0] = ((x[0] & 0x7C) >> 2) + '@';	89	name[0] = ((x[0] & 0x7C) >> 2) + '@';
90	name[1] = ((x[0] & 0x03) << 3) + ((x[1] & 0xE0) >> 5) + '@';	90	name[1] = ((x[0] & 0x03) << 3) + ((x[1] & 0xE0) >> 5) + '@';
91	name[2] = (x[1] & 0x1F) + '@';	91	name[2] = (x[1] & 0x1F) + '@';
92	name[3] = 0;	92	name[3] = 0;
93		93
94	return name;	94	return name;
95	}	95	}
96		96
97	bool set_mode(struct drm_device dev, struct drm_connector connector,	97	bool set_mode(struct drm_device dev, struct drm_connector connector,
98	videomode_t *reqmode, bool strict)	98	videomode_t *reqmode, bool strict)
99	{	99	{
100	drm_i915_private_t *dev_priv = dev->dev_private;	100	drm_i915_private_t *dev_priv = dev->dev_private;
101	struct drm_fb_helper *fb_helper = &dev_priv->fbdev->helper;	101	struct drm_fb_helper *fb_helper = &dev_priv->fbdev->helper;
102		102
103	struct drm_mode_config *config = &dev->mode_config;	103	struct drm_mode_config *config = &dev->mode_config;
104	struct drm_display_mode mode = NULL, tmpmode;	104	struct drm_display_mode mode = NULL, tmpmode;
105	struct drm_framebuffer *fb = NULL;	105	struct drm_framebuffer *fb = NULL;
106	struct drm_crtc *crtc;	106	struct drm_crtc *crtc;
107	struct drm_encoder *encoder;	107	struct drm_encoder *encoder;
108	struct drm_mode_set set;	108	struct drm_i915_gem_object *fb_obj;
-		109	struct drm_mode_set set;
109	char *con_name;	110	char *con_name;
110	char *enc_name;	111	char *enc_name;
111	unsigned hdisplay, vdisplay;	112	unsigned hdisplay, vdisplay;
112	int ret;	113	int ret;
113		114
114	mutex_lock(&dev->mode_config.mutex);	115	mutex_lock(&dev->mode_config.mutex);
115		116
116	list_for_each_entry(tmpmode, &connector->modes, head)	117	list_for_each_entry(tmpmode, &connector->modes, head)
117	{	118	{
118	if( (drm_mode_width(tmpmode) == reqmode->width) &&	119	if( (drm_mode_width(tmpmode) == reqmode->width) &&
119	(drm_mode_height(tmpmode) == reqmode->height) &&	120	(drm_mode_height(tmpmode) == reqmode->height) &&
120	(drm_mode_vrefresh(tmpmode) == reqmode->freq) )	121	(drm_mode_vrefresh(tmpmode) == reqmode->freq) )
121	{	122	{
122	mode = tmpmode;	123	mode = tmpmode;
123	goto do_set;	124	goto do_set;
124	}	125	}
125	};	126	};
126		127
127	if( (mode == NULL) && (strict == false) )	128	if( (mode == NULL) && (strict == false) )
128	{	129	{
129	list_for_each_entry(tmpmode, &connector->modes, head)	130	list_for_each_entry(tmpmode, &connector->modes, head)
130	{	131	{
131	if( (drm_mode_width(tmpmode) == reqmode->width) &&	132	if( (drm_mode_width(tmpmode) == reqmode->width) &&
132	(drm_mode_height(tmpmode) == reqmode->height) )	133	(drm_mode_height(tmpmode) == reqmode->height) )
133	{	134	{
134	mode = tmpmode;	135	mode = tmpmode;
135	goto do_set;	136	goto do_set;
136	}	137	}
137	};	138	};
138	};	139	};
139		140
140	DRM_ERROR("%s failed\n", __FUNCTION__);	141	DRM_ERROR("%s failed\n", __FUNCTION__);
141		142
142	return -1;	143	return -1;
143		144
144	do_set:	145	do_set:
145		146
146	encoder = connector->encoder;	147	encoder = connector->encoder;
147	crtc = encoder->crtc;	148	crtc = encoder->crtc;
148		149
149	con_name = drm_get_connector_name(connector);	150	con_name = drm_get_connector_name(connector);
150	enc_name = drm_get_encoder_name(encoder);	151	enc_name = drm_get_encoder_name(encoder);
151		152
152	DRM_DEBUG_KMS("set mode %d %d: crtc %d connector %s encoder %s\n",	153	DRM_DEBUG_KMS("set mode %d %d: crtc %d connector %s encoder %s\n",
153	reqmode->width, reqmode->height, crtc->base.id,	154	reqmode->width, reqmode->height, crtc->base.id,
154	con_name, enc_name);	155	con_name, enc_name);
155		156
156	drm_mode_set_crtcinfo(mode, CRTC_INTERLACE_HALVE_V);	157	drm_mode_set_crtcinfo(mode, CRTC_INTERLACE_HALVE_V);
157		158
158	hdisplay = mode->hdisplay;	159	hdisplay = mode->hdisplay;
159	vdisplay = mode->vdisplay;	160	vdisplay = mode->vdisplay;
160		161
161	if (crtc->invert_dimensions)	162	if (crtc->invert_dimensions)
162	swap(hdisplay, vdisplay);	163	swap(hdisplay, vdisplay);
163		164
-		165	fb_obj = get_fb_obj();
164	fb = fb_helper->fb;	166	fb = fb_helper->fb;
165		167
166	fb->width = reqmode->width;	168	fb->width = reqmode->width;
167	fb->height = reqmode->height;	169	fb->height = reqmode->height;
168	fb->pitches[0] = ALIGN(reqmode->width * 4, 64);	170
-		171	fb->pitches[0] = fb->pitches[1] = fb->pitches[2] =
169	fb->pitches[1] = ALIGN(reqmode->width * 4, 64);	172	fb->pitches[3] = ALIGN(reqmode->width * 4, 512);
170	fb->pitches[2] = ALIGN(reqmode->width * 4, 64);	173
171	fb->pitches[3] = ALIGN(reqmode->width * 4, 64);	-
-		174	fb_obj->stride = fb->pitches[0];
172		175
173	fb->bits_per_pixel = 32;	176	fb->bits_per_pixel = 32;
174	fb->depth = 24;	177	fb->depth = 24;
175		178
176	crtc->fb = fb;	179	crtc->fb = fb;
177	crtc->enabled = true;	180	crtc->enabled = true;
178	os_display->crtc = crtc;	181	os_display->crtc = crtc;
179		182
-		183	i915_gem_object_put_fence(fb_obj);
-		184
180	set.crtc = crtc;	185	set.crtc = crtc;
181	set.x = 0;	186	set.x = 0;
182	set.y = 0;	187	set.y = 0;
183	set.mode = mode;	188	set.mode = mode;
184	set.connectors = &connector;	189	set.connectors = &connector;
185	set.num_connectors = 1;	190	set.num_connectors = 1;
186	set.fb = fb;	191	set.fb = fb;
187	ret = crtc->funcs->set_config(&set);	192	ret = crtc->funcs->set_config(&set);
188	mutex_unlock(&dev->mode_config.mutex);	193	mutex_unlock(&dev->mode_config.mutex);
189		194
190	if ( !ret )	195	if ( !ret )
191	{	196	{
192	os_display->width = fb->width;	197	os_display->width = fb->width;
193	os_display->height = fb->height;	198	os_display->height = fb->height;
194	os_display->pitch = fb->pitches[0];	199	os_display->pitch = fb->pitches[0];
195	os_display->vrefresh = drm_mode_vrefresh(mode);	200	os_display->vrefresh = drm_mode_vrefresh(mode);
196		201
197	sysSetScreen(fb->width, fb->height, fb->pitches[0]);	202	sysSetScreen(fb->width, fb->height, fb->pitches[0]);
198		203
199	DRM_DEBUG_KMS("new mode %d x %d pitch %d\n",	204	DRM_DEBUG_KMS("new mode %d x %d pitch %d\n",
200	fb->width, fb->height, fb->pitches[0]);	205	fb->width, fb->height, fb->pitches[0]);
201	}	206	}
202	else	207	else
203	DRM_ERROR("failed to set mode %d_%d on crtc %p\n",	208	DRM_ERROR("failed to set mode %d_%d on crtc %p\n",
204	fb->width, fb->height, crtc);	209	fb->width, fb->height, crtc);
205		210
206		211
207	return ret;	212	return ret;
208	}	213	}
209		214
210	static int count_connector_modes(struct drm_connector* connector)	215	static int count_connector_modes(struct drm_connector* connector)
211	{	216	{
212	struct drm_display_mode *mode;	217	struct drm_display_mode *mode;
213	int count = 0;	218	int count = 0;
214		219
215	list_for_each_entry(mode, &connector->modes, head)	220	list_for_each_entry(mode, &connector->modes, head)
216	{	221	{
217	count++;	222	count++;
218	};	223	};
219	return count;	224	return count;
220	};	225	};
221		226
222	static struct drm_connector* get_def_connector(struct drm_device *dev)	227	static struct drm_connector* get_def_connector(struct drm_device *dev)
223	{	228	{
224	struct drm_connector *connector;	229	struct drm_connector *connector;
225	struct drm_connector_helper_funcs *connector_funcs;	230	struct drm_connector_helper_funcs *connector_funcs;
226		231
227	struct drm_connector *def_connector = NULL;	232	struct drm_connector *def_connector = NULL;
228		233
229	list_for_each_entry(connector, &dev->mode_config.connector_list, head)	234	list_for_each_entry(connector, &dev->mode_config.connector_list, head)
230	{	235	{
231	struct drm_encoder *encoder;	236	struct drm_encoder *encoder;
232	struct drm_crtc *crtc;	237	struct drm_crtc *crtc;
233		238
234	if( connector->status != connector_status_connected)	239	if( connector->status != connector_status_connected)
235	continue;	240	continue;
236		241
237	connector_funcs = connector->helper_private;	242	connector_funcs = connector->helper_private;
238	encoder = connector_funcs->best_encoder(connector);	243	encoder = connector_funcs->best_encoder(connector);
239	if( encoder == NULL)	244	if( encoder == NULL)
240	continue;	245	continue;
241		246
242	connector->encoder = encoder;	247	connector->encoder = encoder;
243		248
244	crtc = encoder->crtc;	249	crtc = encoder->crtc;
245		250
246	DRM_DEBUG_KMS("CONNECTOR %x ID: %d status %d encoder %x\n crtc %x",	251	DRM_DEBUG_KMS("CONNECTOR %x ID: %d status %d encoder %x\n crtc %x",
247	connector, connector->base.id,	252	connector, connector->base.id,
248	connector->status, connector->encoder,	253	connector->status, connector->encoder,
249	crtc);	254	crtc);
250		255
251	// if (crtc == NULL)	256	// if (crtc == NULL)
252	// continue;	257	// continue;
253		258
254	def_connector = connector;	259	def_connector = connector;
255		260
256	break;	261	break;
257	};	262	};
258		263
259	return def_connector;	264	return def_connector;
260	};	265	};
261		266
262		267
263	int init_display_kms(struct drm_device *dev)	268	int init_display_kms(struct drm_device dev, videomode_t usermode)
264	{	269	{
265	struct drm_connector *connector;	270	struct drm_connector *connector;
266	struct drm_connector_helper_funcs *connector_funcs;	271	struct drm_connector_helper_funcs *connector_funcs;
267	struct drm_encoder *encoder;	272	struct drm_encoder *encoder;
268	struct drm_crtc *crtc = NULL;	273	struct drm_crtc *crtc = NULL;
269	struct drm_framebuffer *fb;	274	struct drm_framebuffer *fb;
270		275
271	cursor_t *cursor;	276	cursor_t *cursor;
272	u32_t ifl;	277	u32_t ifl;
273	int err;	278	int err;
274		279
-		280	ENTER();
-		281
-		282	mutex_lock(&dev->mode_config.mutex);
-		283
275	list_for_each_entry(connector, &dev->mode_config.connector_list, head)	284	list_for_each_entry(connector, &dev->mode_config.connector_list, head)
276	{	285	{
277	if( connector->status != connector_status_connected)	286	if( connector->status != connector_status_connected)
278	continue;	287	continue;
279		288
280	connector_funcs = connector->helper_private;	289	connector_funcs = connector->helper_private;
281	encoder = connector_funcs->best_encoder(connector);	290	encoder = connector_funcs->best_encoder(connector);
282	if( encoder == NULL)	291	if( encoder == NULL)
283	{	292	{
284	DRM_DEBUG_KMS("CONNECTOR %x ID: %d no active encoders\n",	293	DRM_DEBUG_KMS("CONNECTOR %x ID: %d no active encoders\n",
285	connector, connector->base.id);	294	connector, connector->base.id);
286	continue;	295	continue;
287	}	296	}
288	connector->encoder = encoder;	297	connector->encoder = encoder;
289	crtc = encoder->crtc;	298	crtc = encoder->crtc;
290		299
291	DRM_DEBUG_KMS("CONNECTOR %x ID:%d status:%d ENCODER %x CRTC %x ID:%d\n",	300	DRM_DEBUG_KMS("CONNECTOR %p ID:%d status:%d ENCODER %x CRTC %p ID:%d\n",
292	connector, connector->base.id,	301	connector, connector->base.id,
293	connector->status, connector->encoder,	302	connector->status, connector->encoder,
294	crtc, crtc->base.id );	303	crtc, crtc->base.id );
295		304	break;
296	break;	-
297	};	305	};
298		306
299	if(connector == NULL)	307	if(connector == NULL)
300	{	308	{
301	DRM_ERROR("No active connectors!\n");	309	DRM_DEBUG_KMS("No active connectors!\n");
302	return -1;	310	mutex_unlock(&dev->mode_config.mutex);
-		311	return -1;
303	};	312	};
304		313
-		314	dbgprintf("CRTC %p\n", crtc);
-		315
305	if(crtc == NULL)	316	if(crtc == NULL)
306	{	317	{
307	struct drm_crtc *tmp_crtc;	318	struct drm_crtc *tmp_crtc;
308	int crtc_mask = 1;	319	int crtc_mask = 1;
309		320
310	list_for_each_entry(tmp_crtc, &dev->mode_config.crtc_list, head)	321	list_for_each_entry(tmp_crtc, &dev->mode_config.crtc_list, head)
311	{	322	{
312	if (encoder->possible_crtcs & crtc_mask)	323	dbgprintf("tmp_crtc %p\n", tmp_crtc);
-		324	if (encoder->possible_crtcs & crtc_mask)
313	{	325	{
314	crtc = tmp_crtc;	326	crtc = tmp_crtc;
315	encoder->crtc = crtc;	327	encoder->crtc = crtc;
316	break;	328	dbgprintf("CRTC %p\n", crtc);
-		329	break;
317	};	330	};
318	crtc_mask <<= 1;	331	crtc_mask <<= 1;
319	};	332	};
320	};	333	};
321		334
-		335	dbgprintf("CRTC %p\n", crtc);
-		336
322	if(crtc == NULL)	337	if(crtc == NULL)
323	{	338	{
324	DRM_ERROR("No CRTC for encoder %d\n", encoder->base.id);	339	DRM_DEBUG_KMS("No CRTC for encoder %d\n", encoder->base.id);
-		340	mutex_unlock(&dev->mode_config.mutex);
325	return -1;	341	return -1;
326	};	342	};
327		343
328		-
329	DRM_DEBUG_KMS("[Select CRTC:%d]\n", crtc->base.id);	344	DRM_DEBUG_KMS("[Select CRTC: %p ID:%d]\n",crtc, crtc->base.id);
330		345
331	os_display = GetDisplay();	346	os_display = GetDisplay();
332	os_display->ddev = dev;	347	os_display->ddev = dev;
333	os_display->connector = connector;	348	os_display->connector = connector;
334	os_display->crtc = crtc;	349	os_display->crtc = crtc;
335		350
336	os_display->supported_modes = count_connector_modes(connector);	351	os_display->supported_modes = count_connector_modes(connector);
337		352
338		353
339	ifl = safe_cli();	354	ifl = safe_cli();
340	{	355	{
341	struct intel_crtc *intel_crtc = to_intel_crtc(os_display->crtc);	356	struct intel_crtc *intel_crtc = to_intel_crtc(os_display->crtc);
342		357
343	list_for_each_entry(cursor, &os_display->cursors, list)	358	list_for_each_entry(cursor, &os_display->cursors, list)
344	{	359	{
345	init_cursor(cursor);	360	init_cursor(cursor);
346	};	361	};
347		362
348	os_display->restore_cursor(0,0);	363	os_display->restore_cursor(0,0);
349	os_display->init_cursor = init_cursor;	364	os_display->init_cursor = init_cursor;
350	os_display->select_cursor = select_cursor_kms;	365	os_display->select_cursor = select_cursor_kms;
351	os_display->show_cursor = NULL;	366	os_display->show_cursor = NULL;
352	os_display->move_cursor = move_cursor_kms;	367	os_display->move_cursor = move_cursor_kms;
353	os_display->restore_cursor = restore_cursor;	368	os_display->restore_cursor = restore_cursor;
354	os_display->disable_mouse = disable_mouse;	369	os_display->disable_mouse = disable_mouse;
355		370
356	intel_crtc->cursor_x = os_display->width/2;	371	intel_crtc->cursor_x = os_display->width/2;
357	intel_crtc->cursor_y = os_display->height/2;	372	intel_crtc->cursor_y = os_display->height/2;
358		373
359	select_cursor_kms(os_display->cursor);	374	select_cursor_kms(os_display->cursor);
360	};	375	};
361	safe_sti(ifl);	376	safe_sti(ifl);
362		377
-		378	if( (usermode->width == 0) \|\|
-		379	(usermode->height == 0))
-		380	{
-		381	struct drm_display_mode *mode;
-		382
-		383	// connector->funcs->fill_modes(connector, dev->mode_config.max_width,
-		384	// dev->mode_config.max_height);
-		385
-		386	list_for_each_entry(mode, &connector->modes, head)
-		387	{
-		388	printf("check mode w:%d h:%d %dHz\n",
-		389	drm_mode_width(mode), drm_mode_height(mode),
-		390	drm_mode_vrefresh(mode));
-		391
-		392	if( os_display->width == drm_mode_width(mode) &&
-		393	os_display->height == drm_mode_height(mode) &&
-		394	drm_mode_vrefresh(mode) == 60)
-		395	{
-		396	usermode->width = os_display->width;
-		397	usermode->height = os_display->height;
-		398	usermode->freq = 60;
-		399	break;
-		400
-		401	}
-		402	}
-		403
-		404	if( usermode->width == 0 \|\|
-		405	usermode->height == 0)
-		406	{
-		407	mode = list_entry(connector->modes.next, typeof(*mode), head);
-		408
-		409	usermode->width = drm_mode_width(mode);
-		410	usermode->height = drm_mode_height(mode);
-		411	usermode->freq = drm_mode_vrefresh(mode);
-		412	};
-		413	};
-		414
-		415	mutex_unlock(&dev->mode_config.mutex);
-		416
-		417	set_mode(dev, os_display->connector, usermode, false);
-		418
363	#ifdef __HWA__	419	#ifdef __HWA__
364	err = init_bitmaps();	420	err = init_bitmaps();
365	#endif	421	#endif
366		422
-		423	LEAVE();
-		424
367	return 0;	425	return 0;
368	};	426	};
369		427
370		428
371	int get_videomodes(videomode_t mode, int count)	429	int get_videomodes(videomode_t mode, int count)
372	{	430	{
373	int err = -1;	431	int err = -1;
374		432
375	// dbgprintf("mode %x count %d\n", mode, *count);	433	// dbgprintf("mode %x count %d\n", mode, *count);
376		434
377	if( *count == 0 )	435	if( *count == 0 )
378	{	436	{
379	*count = os_display->supported_modes;	437	*count = os_display->supported_modes;
380	err = 0;	438	err = 0;
381	}	439	}
382	else if( mode != NULL )	440	else if( mode != NULL )
383	{	441	{
384	struct drm_display_mode *drmmode;	442	struct drm_display_mode *drmmode;
385	int i = 0;	443	int i = 0;
386		444
387	if( *count > os_display->supported_modes)	445	if( *count > os_display->supported_modes)
388	*count = os_display->supported_modes;	446	*count = os_display->supported_modes;
389		447
390	list_for_each_entry(drmmode, &os_display->connector->modes, head)	448	list_for_each_entry(drmmode, &os_display->connector->modes, head)
391	{	449	{
392	if( i < *count)	450	if( i < *count)
393	{	451	{
394	mode->width = drm_mode_width(drmmode);	452	mode->width = drm_mode_width(drmmode);
395	mode->height = drm_mode_height(drmmode);	453	mode->height = drm_mode_height(drmmode);
396	mode->bpp = 32;	454	mode->bpp = 32;
397	mode->freq = drm_mode_vrefresh(drmmode);	455	mode->freq = drm_mode_vrefresh(drmmode);
398	i++;	456	i++;
399	mode++;	457	mode++;
400	}	458	}
401	else break;	459	else break;
402	};	460	};
403	*count = i;	461	*count = i;
404	err = 0;	462	err = 0;
405	};	463	};
406	return err;	464	return err;
407	};	465	};
408		466
409	int set_user_mode(videomode_t *mode)	467	int set_user_mode(videomode_t *mode)
410	{	468	{
411	int err = -1;	469	int err = -1;
412		470
413	// dbgprintf("width %d height %d vrefresh %d\n",	471	// dbgprintf("width %d height %d vrefresh %d\n",
414	// mode->width, mode->height, mode->freq);	472	// mode->width, mode->height, mode->freq);
415		473
416	if( (mode->width != 0) &&	474	if( (mode->width != 0) &&
417	(mode->height != 0) &&	475	(mode->height != 0) &&
418	(mode->freq != 0 ) &&	476	(mode->freq != 0 ) &&
419	( (mode->width != os_display->width) \|\|	477	( (mode->width != os_display->width) \|\|
420	(mode->height != os_display->height) \|\|	478	(mode->height != os_display->height) \|\|
421	(mode->freq != os_display->vrefresh) ) )	479	(mode->freq != os_display->vrefresh) ) )
422	{	480	{
423	if( set_mode(os_display->ddev, os_display->connector, mode, true) )	481	if( set_mode(os_display->ddev, os_display->connector, mode, true) )
424	err = 0;	482	err = 0;
425	};	483	};
426		484
427	return err;	485	return err;
428	};	486	};
429		487
430	void i915_dpms(struct drm_device *dev, int mode)	488	void i915_dpms(struct drm_device *dev, int mode)
431	{	489	{
432	struct drm_connector_funcs *f = os_display->connector->funcs;	490	struct drm_connector_funcs *f = os_display->connector->funcs;
433		491
434	f->dpms(os_display->connector, mode);	492	f->dpms(os_display->connector, mode);
435	};	493	};
436		494
437	void __attribute__((regparm(1))) destroy_cursor(cursor_t *cursor)	495	void __attribute__((regparm(1))) destroy_cursor(cursor_t *cursor)
438	{	496	{
439	list_del(&cursor->list);	497	list_del(&cursor->list);

Subversion Repositories Kolibri OS

(root)/drivers/video/drm/i915/kms_display.c – Rev 4126 → 4280