/* * DRM based mode setting test program * Copyright 2008 Tungsten Graphics * Jakob Bornecrantz * Copyright 2008 Intel Corporation * Jesse Barnes * * 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, sublicense, * 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 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 NONINFRINGEMENT. IN NO EVENT SHALL THE * AUTHORS OR COPYRIGHT HOLDERS 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. */ /* * This fairly simple test program dumps output in a similar format to the * "xrandr" tool everyone knows & loves. It's necessarily slightly different * since the kernel separates outputs into encoder and connector structures, * each with their own unique ID. The program also allows test testing of the * memory management and mode setting APIs by allowing the user to specify a * connector and mode to use for mode setting. If all works as expected, a * blue background should be painted on the monitor attached to the specified * connector after the selected mode is set. * * TODO: use cairo to write the mode info on the selected output once * the mode has been programmed, along with possible test patterns. */ #include "config.h" #include #include #include #include #include #include #include #include #include #include #include "xf86drm.h" #include "xf86drmMode.h" #include "drm_fourcc.h" #include "libkms.h" #ifdef HAVE_CAIRO #include #include #endif drmModeRes *resources; int fd, modes; #define ARRAY_SIZE(arr) (sizeof(arr) / sizeof((arr)[0])) struct type_name { int type; char *name; }; #define type_name_fn(res) \ char * res##_str(int type) { \ unsigned int i; \ for (i = 0; i < ARRAY_SIZE(res##_names); i++) { \ if (res##_names[i].type == type) \ return res##_names[i].name; \ } \ return "(invalid)"; \ } struct type_name encoder_type_names[] = { { DRM_MODE_ENCODER_NONE, "none" }, { DRM_MODE_ENCODER_DAC, "DAC" }, { DRM_MODE_ENCODER_TMDS, "TMDS" }, { DRM_MODE_ENCODER_LVDS, "LVDS" }, { DRM_MODE_ENCODER_TVDAC, "TVDAC" }, }; type_name_fn(encoder_type) struct type_name connector_status_names[] = { { DRM_MODE_CONNECTED, "connected" }, { DRM_MODE_DISCONNECTED, "disconnected" }, { DRM_MODE_UNKNOWNCONNECTION, "unknown" }, }; type_name_fn(connector_status) struct type_name connector_type_names[] = { { DRM_MODE_CONNECTOR_Unknown, "unknown" }, { DRM_MODE_CONNECTOR_VGA, "VGA" }, { DRM_MODE_CONNECTOR_DVII, "DVI-I" }, { DRM_MODE_CONNECTOR_DVID, "DVI-D" }, { DRM_MODE_CONNECTOR_DVIA, "DVI-A" }, { DRM_MODE_CONNECTOR_Composite, "composite" }, { DRM_MODE_CONNECTOR_SVIDEO, "s-video" }, { DRM_MODE_CONNECTOR_LVDS, "LVDS" }, { DRM_MODE_CONNECTOR_Component, "component" }, { DRM_MODE_CONNECTOR_9PinDIN, "9-pin DIN" }, { DRM_MODE_CONNECTOR_DisplayPort, "displayport" }, { DRM_MODE_CONNECTOR_HDMIA, "HDMI-A" }, { DRM_MODE_CONNECTOR_HDMIB, "HDMI-B" }, { DRM_MODE_CONNECTOR_TV, "TV" }, { DRM_MODE_CONNECTOR_eDP, "embedded displayport" }, }; type_name_fn(connector_type) #define bit_name_fn(res) \ char * res##_str(int type) { \ int i; \ const char *sep = ""; \ for (i = 0; i < ARRAY_SIZE(res##_names); i++) { \ if (type & (1 << i)) { \ printf("%s%s", sep, res##_names[i]); \ sep = ", "; \ } \ } \ } static const char *mode_type_names[] = { "builtin", "clock_c", "crtc_c", "preferred", "default", "userdef", "driver", }; bit_name_fn(mode_type) static const char *mode_flag_names[] = { "phsync", "nhsync", "pvsync", "nvsync", "interlace", "dblscan", "csync", "pcsync", "ncsync", "hskew", "bcast", "pixmux", "dblclk", "clkdiv2" }; bit_name_fn(mode_flag) void dump_encoders(void) { drmModeEncoder *encoder; int i; printf("Encoders:\n"); printf("id\tcrtc\ttype\tpossible crtcs\tpossible clones\t\n"); for (i = 0; i < resources->count_encoders; i++) { encoder = drmModeGetEncoder(fd, resources->encoders[i]); if (!encoder) { fprintf(stderr, "could not get encoder %i: %s\n", resources->encoders[i], strerror(errno)); continue; } printf("%d\t%d\t%s\t0x%08x\t0x%08x\n", encoder->encoder_id, encoder->crtc_id, encoder_type_str(encoder->encoder_type), encoder->possible_crtcs, encoder->possible_clones); drmModeFreeEncoder(encoder); } printf("\n"); } void dump_mode(drmModeModeInfo *mode) { printf(" %s %d %d %d %d %d %d %d %d %d", mode->name, mode->vrefresh, mode->hdisplay, mode->hsync_start, mode->hsync_end, mode->htotal, mode->vdisplay, mode->vsync_start, mode->vsync_end, mode->vtotal); printf(" flags: "); mode_flag_str(mode->flags); printf("; type: "); mode_type_str(mode->type); printf("\n"); } static void dump_blob(uint32_t blob_id) { uint32_t i; unsigned char *blob_data; drmModePropertyBlobPtr blob; blob = drmModeGetPropertyBlob(fd, blob_id); if (!blob) return; blob_data = blob->data; for (i = 0; i < blob->length; i++) { if (i % 16 == 0) printf("\n\t\t\t"); printf("%.2hhx", blob_data[i]); } printf("\n"); drmModeFreePropertyBlob(blob); } static void dump_prop(uint32_t prop_id, uint64_t value) { int i; drmModePropertyPtr prop; prop = drmModeGetProperty(fd, prop_id); printf("\t%d", prop_id); if (!prop) { printf("\n"); return; } printf(" %s:\n", prop->name); printf("\t\tflags:"); if (prop->flags & DRM_MODE_PROP_PENDING) printf(" pending"); if (prop->flags & DRM_MODE_PROP_RANGE) printf(" range"); if (prop->flags & DRM_MODE_PROP_IMMUTABLE) printf(" immutable"); if (prop->flags & DRM_MODE_PROP_ENUM) printf(" enum"); if (prop->flags & DRM_MODE_PROP_BITMASK) printf(" bitmask"); if (prop->flags & DRM_MODE_PROP_BLOB) printf(" blob"); printf("\n"); if (prop->flags & DRM_MODE_PROP_RANGE) { printf("\t\tvalues:"); for (i = 0; i < prop->count_values; i++) printf(" %"PRIu64, prop->values[i]); printf("\n"); } if (prop->flags & DRM_MODE_PROP_ENUM) { printf("\t\tenums:"); for (i = 0; i < prop->count_enums; i++) printf(" %s=%llu", prop->enums[i].name, prop->enums[i].value); printf("\n"); } else if (prop->flags & DRM_MODE_PROP_BITMASK) { printf("\t\tvalues:"); for (i = 0; i < prop->count_enums; i++) printf(" %s=0x%llx", prop->enums[i].name, (1LL << prop->enums[i].value)); printf("\n"); } else { assert(prop->count_enums == 0); } if (prop->flags & DRM_MODE_PROP_BLOB) { printf("\t\tblobs:\n"); for (i = 0; i < prop->count_blobs; i++) dump_blob(prop->blob_ids[i]); printf("\n"); } else { assert(prop->count_blobs == 0); } printf("\t\tvalue:"); if (prop->flags & DRM_MODE_PROP_BLOB) dump_blob(value); else printf(" %"PRIu64"\n", value); drmModeFreeProperty(prop); } void dump_connectors(void) { drmModeConnector *connector; int i, j; printf("Connectors:\n"); printf("id\tencoder\tstatus\t\ttype\tsize (mm)\tmodes\tencoders\n"); for (i = 0; i < resources->count_connectors; i++) { connector = drmModeGetConnector(fd, resources->connectors[i]); if (!connector) { fprintf(stderr, "could not get connector %i: %s\n", resources->connectors[i], strerror(errno)); continue; } printf("%d\t%d\t%s\t%s\t%dx%d\t\t%d\t", connector->connector_id, connector->encoder_id, connector_status_str(connector->connection), connector_type_str(connector->connector_type), connector->mmWidth, connector->mmHeight, connector->count_modes); for (j = 0; j < connector->count_encoders; j++) printf("%s%d", j > 0 ? ", " : "", connector->encoders[j]); printf("\n"); if (connector->count_modes) { printf(" modes:\n"); printf("\tname refresh (Hz) hdisp hss hse htot vdisp " "vss vse vtot)\n"); for (j = 0; j < connector->count_modes; j++) dump_mode(&connector->modes[j]); printf(" props:\n"); for (j = 0; j < connector->count_props; j++) dump_prop(connector->props[j], connector->prop_values[j]); } drmModeFreeConnector(connector); } printf("\n"); } void dump_crtcs(void) { drmModeCrtc *crtc; drmModeObjectPropertiesPtr props; int i; uint32_t j; printf("CRTCs:\n"); printf("id\tfb\tpos\tsize\n"); for (i = 0; i < resources->count_crtcs; i++) { crtc = drmModeGetCrtc(fd, resources->crtcs[i]); if (!crtc) { fprintf(stderr, "could not get crtc %i: %s\n", resources->crtcs[i], strerror(errno)); continue; } printf("%d\t%d\t(%d,%d)\t(%dx%d)\n", crtc->crtc_id, crtc->buffer_id, crtc->x, crtc->y, crtc->width, crtc->height); dump_mode(&crtc->mode); printf(" props:\n"); props = drmModeObjectGetProperties(fd, crtc->crtc_id, DRM_MODE_OBJECT_CRTC); if (props) { for (j = 0; j < props->count_props; j++) dump_prop(props->props[j], props->prop_values[j]); drmModeFreeObjectProperties(props); } else { printf("\tcould not get crtc properties: %s\n", strerror(errno)); } drmModeFreeCrtc(crtc); } printf("\n"); } void dump_framebuffers(void) { drmModeFB *fb; int i; printf("Frame buffers:\n"); printf("id\tsize\tpitch\n"); for (i = 0; i < resources->count_fbs; i++) { fb = drmModeGetFB(fd, resources->fbs[i]); if (!fb) { fprintf(stderr, "could not get fb %i: %s\n", resources->fbs[i], strerror(errno)); continue; } printf("%u\t(%ux%u)\t%u\n", fb->fb_id, fb->width, fb->height, fb->pitch); drmModeFreeFB(fb); } printf("\n"); } static void dump_planes(void) { drmModeObjectPropertiesPtr props; drmModePlaneRes *plane_resources; drmModePlane *ovr; unsigned int i, j; plane_resources = drmModeGetPlaneResources(fd); if (!plane_resources) { fprintf(stderr, "drmModeGetPlaneResources failed: %s\n", strerror(errno)); return; } printf("Planes:\n"); printf("id\tcrtc\tfb\tCRTC x,y\tx,y\tgamma size\n"); for (i = 0; i < plane_resources->count_planes; i++) { ovr = drmModeGetPlane(fd, plane_resources->planes[i]); if (!ovr) { fprintf(stderr, "drmModeGetPlane failed: %s\n", strerror(errno)); continue; } printf("%d\t%d\t%d\t%d,%d\t\t%d,%d\t%d\n", ovr->plane_id, ovr->crtc_id, ovr->fb_id, ovr->crtc_x, ovr->crtc_y, ovr->x, ovr->y, ovr->gamma_size); if (!ovr->count_formats) continue; printf(" formats:"); for (j = 0; j < ovr->count_formats; j++) printf(" %4.4s", (char *)&ovr->formats[j]); printf("\n"); printf(" props:\n"); props = drmModeObjectGetProperties(fd, ovr->plane_id, DRM_MODE_OBJECT_PLANE); if (props) { for (j = 0; j < props->count_props; j++) dump_prop(props->props[j], props->prop_values[j]); drmModeFreeObjectProperties(props); } else { printf("\tcould not get plane properties: %s\n", strerror(errno)); } drmModeFreePlane(ovr); } printf("\n"); drmModeFreePlaneResources(plane_resources); return; } /* * Mode setting with the kernel interfaces is a bit of a chore. * First you have to find the connector in question and make sure the * requested mode is available. * Then you need to find the encoder attached to that connector so you * can bind it with a free crtc. */ struct connector { uint32_t id; char mode_str[64]; drmModeModeInfo *mode; drmModeEncoder *encoder; int crtc; int pipe; unsigned int fb_id[2], current_fb_id; struct timeval start; int swap_count; }; struct plane { uint32_t con_id; /* the id of connector to bind to */ uint32_t w, h; unsigned int fb_id; char format_str[5]; /* need to leave room for terminating \0 */ }; static void connector_find_mode(struct connector *c) { drmModeConnector *connector; int i, j; /* First, find the connector & mode */ c->mode = NULL; for (i = 0; i < resources->count_connectors; i++) { connector = drmModeGetConnector(fd, resources->connectors[i]); if (!connector) { fprintf(stderr, "could not get connector %i: %s\n", resources->connectors[i], strerror(errno)); drmModeFreeConnector(connector); continue; } if (!connector->count_modes) { drmModeFreeConnector(connector); continue; } if (connector->connector_id != c->id) { drmModeFreeConnector(connector); continue; } for (j = 0; j < connector->count_modes; j++) { c->mode = &connector->modes[j]; if (!strcmp(c->mode->name, c->mode_str)) break; } /* Found it, break out */ if (c->mode) break; drmModeFreeConnector(connector); } if (!c->mode) { fprintf(stderr, "failed to find mode \"%s\"\n", c->mode_str); return; } /* Now get the encoder */ for (i = 0; i < resources->count_encoders; i++) { c->encoder = drmModeGetEncoder(fd, resources->encoders[i]); if (!c->encoder) { fprintf(stderr, "could not get encoder %i: %s\n", resources->encoders[i], strerror(errno)); drmModeFreeEncoder(c->encoder); continue; } if (c->encoder->encoder_id == connector->encoder_id) break; drmModeFreeEncoder(c->encoder); } if (c->crtc == -1) c->crtc = c->encoder->crtc_id; /* and figure out which crtc index it is: */ for (i = 0; i < resources->count_crtcs; i++) { if (c->crtc == resources->crtcs[i]) { c->pipe = i; break; } } } static struct kms_bo * allocate_buffer(struct kms_driver *kms, int width, int height, int *stride) { struct kms_bo *bo; unsigned bo_attribs[] = { KMS_WIDTH, 0, KMS_HEIGHT, 0, KMS_BO_TYPE, KMS_BO_TYPE_SCANOUT_X8R8G8B8, KMS_TERMINATE_PROP_LIST }; int ret; bo_attribs[1] = width; bo_attribs[3] = height; ret = kms_bo_create(kms, bo_attribs, &bo); if (ret) { fprintf(stderr, "failed to alloc buffer: %s\n", strerror(-ret)); return NULL; } ret = kms_bo_get_prop(bo, KMS_PITCH, stride); if (ret) { fprintf(stderr, "failed to retreive buffer stride: %s\n", strerror(-ret)); kms_bo_destroy(&bo); return NULL; } return bo; } static void make_pwetty(void *data, int width, int height, int stride) { #ifdef HAVE_CAIRO cairo_surface_t *surface; cairo_t *cr; int x, y; surface = cairo_image_surface_create_for_data(data, CAIRO_FORMAT_ARGB32, width, height, stride); cr = cairo_create(surface); cairo_surface_destroy(surface); cairo_set_line_cap(cr, CAIRO_LINE_CAP_SQUARE); for (x = 0; x < width; x += 250) for (y = 0; y < height; y += 250) { char buf[64]; cairo_move_to(cr, x, y - 20); cairo_line_to(cr, x, y + 20); cairo_move_to(cr, x - 20, y); cairo_line_to(cr, x + 20, y); cairo_new_sub_path(cr); cairo_arc(cr, x, y, 10, 0, M_PI * 2); cairo_set_line_width(cr, 4); cairo_set_source_rgb(cr, 0, 0, 0); cairo_stroke_preserve(cr); cairo_set_source_rgb(cr, 1, 1, 1); cairo_set_line_width(cr, 2); cairo_stroke(cr); snprintf(buf, sizeof buf, "%d, %d", x, y); cairo_move_to(cr, x + 20, y + 20); cairo_text_path(cr, buf); cairo_set_source_rgb(cr, 0, 0, 0); cairo_stroke_preserve(cr); cairo_set_source_rgb(cr, 1, 1, 1); cairo_fill(cr); } cairo_destroy(cr); #endif } static int create_test_buffer(struct kms_driver *kms, int width, int height, int *stride_out, struct kms_bo **bo_out) { struct kms_bo *bo; int ret, i, j, stride; void *virtual; bo = allocate_buffer(kms, width, height, &stride); if (!bo) return -1; ret = kms_bo_map(bo, &virtual); if (ret) { fprintf(stderr, "failed to map buffer: %s\n", strerror(-ret)); kms_bo_destroy(&bo); return -1; } /* paint the buffer with colored tiles */ for (j = 0; j < height; j++) { uint32_t *fb_ptr = (uint32_t*)((char*)virtual + j * stride); for (i = 0; i < width; i++) { div_t d = div(i, width); fb_ptr[i] = 0x00130502 * (d.quot >> 6) + 0x000a1120 * (d.rem >> 6); } } make_pwetty(virtual, width, height, stride); kms_bo_unmap(bo); *bo_out = bo; *stride_out = stride; return 0; } static int create_grey_buffer(struct kms_driver *kms, int width, int height, int *stride_out, struct kms_bo **bo_out) { struct kms_bo *bo; int size, ret, stride; void *virtual; bo = allocate_buffer(kms, width, height, &stride); if (!bo) return -1; ret = kms_bo_map(bo, &virtual); if (ret) { fprintf(stderr, "failed to map buffer: %s\n", strerror(-ret)); kms_bo_destroy(&bo); return -1; } size = stride * height; memset(virtual, 0x77, size); kms_bo_unmap(bo); *bo_out = bo; *stride_out = stride; return 0; } void page_flip_handler(int fd, unsigned int frame, unsigned int sec, unsigned int usec, void *data) { struct connector *c; unsigned int new_fb_id; struct timeval end; double t; c = data; if (c->current_fb_id == c->fb_id[0]) new_fb_id = c->fb_id[1]; else new_fb_id = c->fb_id[0]; drmModePageFlip(fd, c->crtc, new_fb_id, DRM_MODE_PAGE_FLIP_EVENT, c); c->current_fb_id = new_fb_id; c->swap_count++; if (c->swap_count == 60) { gettimeofday(&end, NULL); t = end.tv_sec + end.tv_usec * 1e-6 - (c->start.tv_sec + c->start.tv_usec * 1e-6); fprintf(stderr, "freq: %.02fHz\n", c->swap_count / t); c->swap_count = 0; c->start = end; } } /* swap these for big endian.. */ #define RED 2 #define GREEN 1 #define BLUE 0 static void fill420(unsigned char *y, unsigned char *u, unsigned char *v, int cs /*chroma pixel stride */, int n, int width, int height, int stride) { int i, j; /* paint the buffer with colored tiles, in blocks of 2x2 */ for (j = 0; j < height; j+=2) { unsigned char *y1p = y + j * stride; unsigned char *y2p = y1p + stride; unsigned char *up = u + (j/2) * stride * cs / 2; unsigned char *vp = v + (j/2) * stride * cs / 2; for (i = 0; i < width; i+=2) { div_t d = div(n+i+j, width); uint32_t rgb = 0x00130502 * (d.quot >> 6) + 0x000a1120 * (d.rem >> 6); unsigned char *rgbp = (unsigned char *)&rgb; unsigned char y = (0.299 * rgbp[RED]) + (0.587 * rgbp[GREEN]) + (0.114 * rgbp[BLUE]); *(y2p++) = *(y1p++) = y; *(y2p++) = *(y1p++) = y; *up = (rgbp[BLUE] - y) * 0.565 + 128; *vp = (rgbp[RED] - y) * 0.713 + 128; up += cs; vp += cs; } } } static void fill422(unsigned char *virtual, int n, int width, int height, int stride) { int i, j; /* paint the buffer with colored tiles */ for (j = 0; j < height; j++) { uint8_t *ptr = (uint8_t*)((char*)virtual + j * stride); for (i = 0; i < width; i++) { div_t d = div(n+i+j, width); uint32_t rgb = 0x00130502 * (d.quot >> 6) + 0x000a1120 * (d.rem >> 6); unsigned char *rgbp = (unsigned char *)&rgb; unsigned char y = (0.299 * rgbp[RED]) + (0.587 * rgbp[GREEN]) + (0.114 * rgbp[BLUE]); *(ptr++) = y; *(ptr++) = (rgbp[BLUE] - y) * 0.565 + 128; *(ptr++) = y; *(ptr++) = (rgbp[RED] - y) * 0.713 + 128; } } } static void fill1555(unsigned char *virtual, int n, int width, int height, int stride) { int i, j; /* paint the buffer with colored tiles */ for (j = 0; j < height; j++) { uint16_t *ptr = (uint16_t*)((char*)virtual + j * stride); for (i = 0; i < width; i++) { div_t d = div(n+i+j, width); uint32_t rgb = 0x00130502 * (d.quot >> 6) + 0x000a1120 * (d.rem >> 6); unsigned char *rgbp = (unsigned char *)&rgb; *(ptr++) = 0x8000 | (rgbp[RED] >> 3) << 10 | (rgbp[GREEN] >> 3) << 5 | (rgbp[BLUE] >> 3); } } } static int set_plane(struct kms_driver *kms, struct connector *c, struct plane *p) { drmModePlaneRes *plane_resources; drmModePlane *ovr; uint32_t handles[4], pitches[4], offsets[4] = {0}; /* we only use [0] */ uint32_t plane_id = 0; struct kms_bo *plane_bo; uint32_t plane_flags = 0, format; int ret, crtc_x, crtc_y, crtc_w, crtc_h; unsigned int i; /* find an unused plane which can be connected to our crtc */ plane_resources = drmModeGetPlaneResources(fd); if (!plane_resources) { fprintf(stderr, "drmModeGetPlaneResources failed: %s\n", strerror(errno)); return -1; } for (i = 0; i < plane_resources->count_planes && !plane_id; i++) { ovr = drmModeGetPlane(fd, plane_resources->planes[i]); if (!ovr) { fprintf(stderr, "drmModeGetPlane failed: %s\n", strerror(errno)); return -1; } if ((ovr->possible_crtcs & (1 << c->pipe)) && !ovr->crtc_id) plane_id = ovr->plane_id; drmModeFreePlane(ovr); } fprintf(stderr, "testing %dx%d@%s overlay plane\n", p->w, p->h, p->format_str); if (!plane_id) { fprintf(stderr, "failed to find plane!\n"); return -1; } if (!strcmp(p->format_str, "XR24")) { if (create_test_buffer(kms, p->w, p->h, &pitches[0], &plane_bo)) return -1; kms_bo_get_prop(plane_bo, KMS_HANDLE, &handles[0]); format = DRM_FORMAT_XRGB8888; } else { void *virtual; /* TODO: this always allocates a buffer for 32bpp RGB.. but for * YUV formats, we don't use all of it.. since 4bytes/pixel is * worst case, so live with it for now and just don't use all * the buffer: */ plane_bo = allocate_buffer(kms, p->w, p->h, &pitches[0]); if (!plane_bo) return -1; ret = kms_bo_map(plane_bo, &virtual); if (ret) { fprintf(stderr, "failed to map buffer: %s\n", strerror(-ret)); kms_bo_destroy(&plane_bo); return -1; } /* just testing a limited # of formats to test single * and multi-planar path.. would be nice to add more.. */ if (!strcmp(p->format_str, "YUYV")) { pitches[0] = p->w * 2; offsets[0] = 0; kms_bo_get_prop(plane_bo, KMS_HANDLE, &handles[0]); fill422(virtual, 0, p->w, p->h, pitches[0]); format = DRM_FORMAT_YUYV; } else if (!strcmp(p->format_str, "NV12")) { pitches[0] = p->w; offsets[0] = 0; kms_bo_get_prop(plane_bo, KMS_HANDLE, &handles[0]); pitches[1] = p->w; offsets[1] = p->w * p->h; kms_bo_get_prop(plane_bo, KMS_HANDLE, &handles[1]); fill420(virtual, virtual+offsets[1], virtual+offsets[1]+1, 2, 0, p->w, p->h, pitches[0]); format = DRM_FORMAT_NV12; } else if (!strcmp(p->format_str, "YV12")) { pitches[0] = p->w; offsets[0] = 0; kms_bo_get_prop(plane_bo, KMS_HANDLE, &handles[0]); pitches[1] = p->w / 2; offsets[1] = p->w * p->h; kms_bo_get_prop(plane_bo, KMS_HANDLE, &handles[1]); pitches[2] = p->w / 2; offsets[2] = offsets[1] + (p->w * p->h) / 4; kms_bo_get_prop(plane_bo, KMS_HANDLE, &handles[2]); fill420(virtual, virtual+offsets[1], virtual+offsets[2], 1, 0, p->w, p->h, pitches[0]); format = DRM_FORMAT_YVU420; } else if (!strcmp(p->format_str, "XR15")) { pitches[0] = p->w * 2; offsets[0] = 0; kms_bo_get_prop(plane_bo, KMS_HANDLE, &handles[0]); fill1555(virtual, 0, p->w, p->h, pitches[0]); format = DRM_FORMAT_XRGB1555; } else if (!strcmp(p->format_str, "AR15")) { pitches[0] = p->w * 2; offsets[0] = 0; kms_bo_get_prop(plane_bo, KMS_HANDLE, &handles[0]); fill1555(virtual, 0, p->w, p->h, pitches[0]); format = DRM_FORMAT_ARGB1555; } else { fprintf(stderr, "Unknown format: %s\n", p->format_str); return -1; } kms_bo_unmap(plane_bo); } /* just use single plane format for now.. */ if (drmModeAddFB2(fd, p->w, p->h, format, handles, pitches, offsets, &p->fb_id, plane_flags)) { fprintf(stderr, "failed to add fb: %s\n", strerror(errno)); return -1; } /* ok, boring.. but for now put in middle of screen: */ crtc_x = c->mode->hdisplay / 3; crtc_y = c->mode->vdisplay / 3; crtc_w = crtc_x; crtc_h = crtc_y; /* note src coords (last 4 args) are in Q16 format */ if (drmModeSetPlane(fd, plane_id, c->crtc, p->fb_id, plane_flags, crtc_x, crtc_y, crtc_w, crtc_h, 0, 0, p->w << 16, p->h << 16)) { fprintf(stderr, "failed to enable plane: %s\n", strerror(errno)); return -1; } return 0; } static void set_mode(struct connector *c, int count, struct plane *p, int plane_count, int page_flip) { struct kms_driver *kms; struct kms_bo *bo, *other_bo; unsigned int fb_id, other_fb_id; int i, j, ret, width, height, x, stride; unsigned handle; drmEventContext evctx; width = 0; height = 0; for (i = 0; i < count; i++) { connector_find_mode(&c[i]); if (c[i].mode == NULL) continue; width += c[i].mode->hdisplay; if (height < c[i].mode->vdisplay) height = c[i].mode->vdisplay; } ret = kms_create(fd, &kms); if (ret) { fprintf(stderr, "failed to create kms driver: %s\n", strerror(-ret)); return; } if (create_test_buffer(kms, width, height, &stride, &bo)) return; kms_bo_get_prop(bo, KMS_HANDLE, &handle); ret = drmModeAddFB(fd, width, height, 24, 32, stride, handle, &fb_id); if (ret) { fprintf(stderr, "failed to add fb (%ux%u): %s\n", width, height, strerror(errno)); return; } x = 0; for (i = 0; i < count; i++) { if (c[i].mode == NULL) continue; printf("setting mode %s on connector %d, crtc %d\n", c[i].mode_str, c[i].id, c[i].crtc); ret = drmModeSetCrtc(fd, c[i].crtc, fb_id, x, 0, &c[i].id, 1, c[i].mode); /* XXX: Actually check if this is needed */ drmModeDirtyFB(fd, fb_id, NULL, 0); x += c[i].mode->hdisplay; if (ret) { fprintf(stderr, "failed to set mode: %s\n", strerror(errno)); return; } /* if we have a plane/overlay to show, set that up now: */ for (j = 0; j < plane_count; j++) if (p[j].con_id == c[i].id) if (set_plane(kms, &c[i], &p[j])) return; } if (!page_flip) return; if (create_grey_buffer(kms, width, height, &stride, &other_bo)) return; kms_bo_get_prop(other_bo, KMS_HANDLE, &handle); ret = drmModeAddFB(fd, width, height, 32, 32, stride, handle, &other_fb_id); if (ret) { fprintf(stderr, "failed to add fb: %s\n", strerror(errno)); return; } for (i = 0; i < count; i++) { if (c[i].mode == NULL) continue; ret = drmModePageFlip(fd, c[i].crtc, other_fb_id, DRM_MODE_PAGE_FLIP_EVENT, &c[i]); if (ret) { fprintf(stderr, "failed to page flip: %s\n", strerror(errno)); return; } gettimeofday(&c[i].start, NULL); c[i].swap_count = 0; c[i].fb_id[0] = fb_id; c[i].fb_id[1] = other_fb_id; c[i].current_fb_id = other_fb_id; } memset(&evctx, 0, sizeof evctx); evctx.version = DRM_EVENT_CONTEXT_VERSION; evctx.vblank_handler = NULL; evctx.page_flip_handler = page_flip_handler; while (1) { #if 0 struct pollfd pfd[2]; pfd[0].fd = 0; pfd[0].events = POLLIN; pfd[1].fd = fd; pfd[1].events = POLLIN; if (poll(pfd, 2, -1) < 0) { fprintf(stderr, "poll error\n"); break; } if (pfd[0].revents) break; #else struct timeval timeout = { .tv_sec = 3, .tv_usec = 0 }; fd_set fds; int ret; FD_ZERO(&fds); FD_SET(0, &fds); FD_SET(fd, &fds); ret = select(fd + 1, &fds, NULL, NULL, &timeout); if (ret <= 0) { fprintf(stderr, "select timed out or error (ret %d)\n", ret); continue; } else if (FD_ISSET(0, &fds)) { break; } #endif drmHandleEvent(fd, &evctx); } kms_bo_destroy(&bo); kms_bo_destroy(&other_bo); kms_destroy(&kms); } extern char *optarg; extern int optind, opterr, optopt; static char optstr[] = "ecpmfs:P:v"; void usage(char *name) { fprintf(stderr, "usage: %s [-ecpmf]\n", name); fprintf(stderr, "\t-e\tlist encoders\n"); fprintf(stderr, "\t-c\tlist connectors\n"); fprintf(stderr, "\t-p\tlist CRTCs and planes (pipes)\n"); fprintf(stderr, "\t-m\tlist modes\n"); fprintf(stderr, "\t-f\tlist framebuffers\n"); fprintf(stderr, "\t-v\ttest vsynced page flipping\n"); fprintf(stderr, "\t-s :\tset a mode\n"); fprintf(stderr, "\t-s @:\tset a mode\n"); fprintf(stderr, "\t-P :x\tset a plane\n"); fprintf(stderr, "\t-P :x@\tset a plane\n"); fprintf(stderr, "\n\tDefault is to dump all info.\n"); exit(0); } #define dump_resource(res) if (res) dump_##res() static int page_flipping_supported(void) { /*FIXME: generic ioctl needed? */ return 1; #if 0 int ret, value; struct drm_i915_getparam gp; gp.param = I915_PARAM_HAS_PAGEFLIPPING; gp.value = &value; ret = drmCommandWriteRead(fd, DRM_I915_GETPARAM, &gp, sizeof(gp)); if (ret) { fprintf(stderr, "drm_i915_getparam: %m\n"); return 0; } return *gp.value; #endif } int main(int argc, char **argv) { int c; int encoders = 0, connectors = 0, crtcs = 0, planes = 0, framebuffers = 0; int test_vsync = 0; char *modules[] = { "i915", "radeon", "nouveau", "vmwgfx", "omapdrm", "exynos" }; unsigned int i; int count = 0, plane_count = 0; struct connector con_args[2]; struct plane plane_args[2] = {0}; opterr = 0; while ((c = getopt(argc, argv, optstr)) != -1) { switch (c) { case 'e': encoders = 1; break; case 'c': connectors = 1; break; case 'p': crtcs = 1; planes = 1; break; case 'm': modes = 1; break; case 'f': framebuffers = 1; break; case 'v': test_vsync = 1; break; case 's': con_args[count].crtc = -1; if (sscanf(optarg, "%d:%64s", &con_args[count].id, con_args[count].mode_str) != 2 && sscanf(optarg, "%d@%d:%64s", &con_args[count].id, &con_args[count].crtc, con_args[count].mode_str) != 3) usage(argv[0]); count++; break; case 'P': strcpy(plane_args[plane_count].format_str, "XR24"); if (sscanf(optarg, "%d:%dx%d@%4s", &plane_args[plane_count].con_id, &plane_args[plane_count].w, &plane_args[plane_count].h, plane_args[plane_count].format_str) != 4 && sscanf(optarg, "%d:%dx%d", &plane_args[plane_count].con_id, &plane_args[plane_count].w, &plane_args[plane_count].h) != 3) usage(argv[0]); plane_count++; break; default: usage(argv[0]); break; } } if (argc == 1) encoders = connectors = crtcs = planes = modes = framebuffers = 1; for (i = 0; i < ARRAY_SIZE(modules); i++) { printf("trying to load module %s...", modules[i]); fd = drmOpen(modules[i], NULL); if (fd < 0) { printf("failed.\n"); } else { printf("success.\n"); break; } } if (test_vsync && !page_flipping_supported()) { fprintf(stderr, "page flipping not supported by drm.\n"); return -1; } if (i == ARRAY_SIZE(modules)) { fprintf(stderr, "failed to load any modules, aborting.\n"); return -1; } resources = drmModeGetResources(fd); if (!resources) { fprintf(stderr, "drmModeGetResources failed: %s\n", strerror(errno)); drmClose(fd); return 1; } dump_resource(encoders); dump_resource(connectors); dump_resource(crtcs); dump_resource(planes); dump_resource(framebuffers); if (count > 0) { set_mode(con_args, count, plane_args, plane_count, test_vsync); getchar(); } drmModeFreeResources(resources); return 0; } ='#n850'>850 851 852 853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903 904 905 906 907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 984 985 986 987 988 989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 
/* mga_state.c -- State support for MGA G200/G400 -*- linux-c -*-
 * Created: Thu Jan 27 02:53:43 2000 by jhartmann@precisioninsight.com
 */
/*
 * Copyright 1999 Precision Insight, Inc., Cedar Park, Texas.
 * Copyright 2000 VA Linux Systems, Inc., Sunnyvale, California.
 * 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, sublicense,
 * 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 NONINFRINGEMENT.  IN NO EVENT SHALL
 * VA LINUX SYSTEMS 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.
 *
 * Authors:
 *    Jeff Hartmann <jhartmann@valinux.com>
 *    Keith Whitwell <keith@tungstengraphics.com>
 *
 * Rewritten by:
 *    Gareth Hughes <gareth@valinux.com>
 */

#include "drmP.h"
#include "drm.h"
#include "mga_drm.h"
#include "mga_drv.h"

/* ================================================================
 * DMA hardware state programming functions
 */

static void mga_emit_clip_rect(drm_mga_private_t * dev_priv,
			       drm_clip_rect_t * box)
{
	drm_mga_sarea_t *sarea_priv = dev_priv->sarea_priv;
	drm_mga_context_regs_t *ctx = &sarea_priv->context_state;
	unsigned int pitch = dev_priv->front_pitch;
	DMA_LOCALS;

	BEGIN_DMA(2);

	/* Force reset of DWGCTL on G400 (eliminates clip disable bit).
	 */
	if (dev_priv->chipset >= MGA_CARD_TYPE_G400) {
		DMA_BLOCK(MGA_DWGCTL, ctx->dwgctl,
			  MGA_LEN + MGA_EXEC, 0x80000000,
			  MGA_DWGCTL, ctx->dwgctl,
			  MGA_LEN + MGA_EXEC, 0x80000000);
	}
	DMA_BLOCK(MGA_DMAPAD, 0x00000000,
		  MGA_CXBNDRY, ((box->x2 - 1) << 16) | box->x1,
		  MGA_YTOP, box->y1 * pitch,
		  MGA_YBOT, (box->y2 - 1) * pitch);

	ADVANCE_DMA();
}

static __inline__ void mga_g200_emit_context(drm_mga_private_t * dev_priv)
{
	drm_mga_sarea_t *sarea_priv = dev_priv->sarea_priv;
	drm_mga_context_regs_t *ctx = &sarea_priv->context_state;
	DMA_LOCALS;

	BEGIN_DMA(3);

	DMA_BLOCK(MGA_DSTORG, ctx->dstorg,
		  MGA_MACCESS, ctx->maccess,
		  MGA_PLNWT, ctx->plnwt,
		  MGA_DWGCTL, ctx->dwgctl);

	DMA_BLOCK(MGA_ALPHACTRL, ctx->alphactrl,
		  MGA_FOGCOL, ctx->fogcolor,
		  MGA_WFLAG, ctx->wflag,
		  MGA_ZORG, dev_priv->depth_offset);

	DMA_BLOCK(MGA_FCOL, ctx->fcol,
		  MGA_DMAPAD, 0x00000000,
		  MGA_DMAPAD, 0x00000000,
		  MGA_DMAPAD, 0x00000000);

	ADVANCE_DMA();
}

static __inline__ void mga_g400_emit_context(drm_mga_private_t * dev_priv)
{
	drm_mga_sarea_t *sarea_priv = dev_priv->sarea_priv;
	drm_mga_context_regs_t *ctx = &sarea_priv->context_state;
	DMA_LOCALS;

	BEGIN_DMA(4);

	DMA_BLOCK(MGA_DSTORG, ctx->dstorg,
		  MGA_MACCESS, ctx->maccess,
		  MGA_PLNWT, ctx->plnwt,
		  MGA_DWGCTL, ctx->dwgctl);

	DMA_BLOCK(MGA_ALPHACTRL, ctx->alphactrl,
		  MGA_FOGCOL, ctx->fogcolor,
		  MGA_WFLAG, ctx->wflag,
		  MGA_ZORG, dev_priv->depth_offset);

	DMA_BLOCK(MGA_WFLAG1, ctx->wflag,
		  MGA_TDUALSTAGE0, ctx->tdualstage0,
		  MGA_TDUALSTAGE1, ctx->tdualstage1,
		  MGA_FCOL, ctx->fcol);

	DMA_BLOCK(MGA_STENCIL, ctx->stencil,
		  MGA_STENCILCTL, ctx->stencilctl,
		  MGA_DMAPAD, 0x00000000,
		  MGA_DMAPAD, 0x00000000);

	ADVANCE_DMA();
}

static __inline__ void mga_g200_emit_tex0(drm_mga_private_t * dev_priv)
{
	drm_mga_sarea_t *sarea_priv = dev_priv->sarea_priv;
	drm_mga_texture_regs_t *tex = &sarea_priv->tex_state[0];
	DMA_LOCALS;

	BEGIN_DMA(4);

	DMA_BLOCK(MGA_TEXCTL2, tex->texctl2,
		  MGA_TEXCTL, tex->texctl,
		  MGA_TEXFILTER, tex->texfilter,
		  MGA_TEXBORDERCOL, tex->texbordercol);

	DMA_BLOCK(MGA_TEXORG, tex->texorg,
		  MGA_TEXORG1, tex->texorg1,
		  MGA_TEXORG2, tex->texorg2,
		  MGA_TEXORG3, tex->texorg3);

	DMA_BLOCK(MGA_TEXORG4, tex->texorg4,
		  MGA_TEXWIDTH, tex->texwidth,
		  MGA_TEXHEIGHT, tex->texheight,
		  MGA_WR24, tex->texwidth);

	DMA_BLOCK(MGA_WR34, tex->texheight,
		  MGA_TEXTRANS, 0x0000ffff,
		  MGA_TEXTRANSHIGH, 0x0000ffff,
		  MGA_DMAPAD, 0x00000000);

	ADVANCE_DMA();
}

static __inline__ void mga_g400_emit_tex0(drm_mga_private_t * dev_priv)