]> git.ipfire.org Git - people/ms/u-boot.git/blobdiff - lib/efi_loader/efi_gop.c
efi_loader: manage protocols in a linked list
[people/ms/u-boot.git] / lib / efi_loader / efi_gop.c
index dc6e2615ccc1b800ba874ee53eb31392a4a3efa9..498184d754209bfa2df9f73539933520e977a496 100644 (file)
@@ -7,10 +7,12 @@
  */
 
 #include <common.h>
+#include <dm.h>
 #include <efi_loader.h>
 #include <inttypes.h>
 #include <lcd.h>
 #include <malloc.h>
+#include <video.h>
 
 DECLARE_GLOBAL_DATA_PTR;
 
@@ -24,10 +26,13 @@ struct efi_gop_obj {
        /* The only mode we support */
        struct efi_gop_mode_info info;
        struct efi_gop_mode mode;
+       /* Fields we only have acces to during init */
+       u32 bpix;
+       void *fb;
 };
 
 static efi_status_t EFIAPI gop_query_mode(struct efi_gop *this, u32 mode_number,
-                                         unsigned long *size_of_info,
+                                         efi_uintn_t *size_of_info,
                                          struct efi_gop_mode_info **info)
 {
        struct efi_gop_obj *gopobj;
@@ -51,29 +56,34 @@ static efi_status_t EFIAPI gop_set_mode(struct efi_gop *this, u32 mode_number)
        return EFI_EXIT(EFI_SUCCESS);
 }
 
-static efi_status_t EFIAPI gop_blt(struct efi_gop *this, void *buffer,
-                                  unsigned long operation, unsigned long sx,
-                                  unsigned long sy, unsigned long dx,
-                                  unsigned long dy, unsigned long width,
-                                  unsigned long height, unsigned long delta)
+efi_status_t EFIAPI gop_blt(struct efi_gop *this, void *buffer,
+                           u32 operation, efi_uintn_t sx,
+                           efi_uintn_t sy, efi_uintn_t dx,
+                           efi_uintn_t dy, efi_uintn_t width,
+                           efi_uintn_t height, efi_uintn_t delta)
 {
+       struct efi_gop_obj *gopobj = container_of(this, struct efi_gop_obj, ops);
        int i, j, line_len16, line_len32;
        void *fb;
 
-       EFI_ENTRY("%p, %p, %lx, %lx, %lx, %lx, %lx, %lx, %lx, %lx", this,
+       EFI_ENTRY("%p, %p, %u, %zu, %zu, %zu, %zu, %zu, %zu, %zu", this,
                  buffer, operation, sx, sy, dx, dy, width, height, delta);
 
        if (operation != EFI_BLT_BUFFER_TO_VIDEO)
                return EFI_EXIT(EFI_INVALID_PARAMETER);
 
-       fb = (void*)gd->fb_base;
-       line_len16 = panel_info.vl_col * sizeof(u16);
-       line_len32 = panel_info.vl_col * sizeof(u32);
+       fb = gopobj->fb;
+       line_len16 = gopobj->info.width * sizeof(u16);
+       line_len32 = gopobj->info.width * sizeof(u32);
 
        /* Copy the contents line by line */
 
-       switch (panel_info.vl_bpix) {
+       switch (gopobj->bpix) {
+#ifdef CONFIG_DM_VIDEO
+       case VIDEO_BPP32:
+#else
        case LCD_COLOR32:
+#endif
                for (i = 0; i < height; i++) {
                        u32 *dest = fb + ((i + dy)  * line_len32) +
                                         (dx * sizeof(u32));
@@ -84,7 +94,11 @@ static efi_status_t EFIAPI gop_blt(struct efi_gop *this, void *buffer,
                        memcpy(dest, src, width * sizeof(u32));
                }
                break;
+#ifdef CONFIG_DM_VIDEO
+       case VIDEO_BPP16:
+#else
        case LCD_COLOR16:
+#endif
                for (i = 0; i < height; i++) {
                        u16 *dest = fb + ((i + dy)  * line_len16) +
                                         (dx * sizeof(u16));
@@ -102,7 +116,11 @@ static efi_status_t EFIAPI gop_blt(struct efi_gop *this, void *buffer,
                break;
        }
 
+#ifdef CONFIG_DM_VIDEO
+       video_sync_all();
+#else
        lcd_sync();
+#endif
 
        return EFI_EXIT(EFI_SUCCESS);
 }
@@ -111,10 +129,44 @@ static efi_status_t EFIAPI gop_blt(struct efi_gop *this, void *buffer,
 int efi_gop_register(void)
 {
        struct efi_gop_obj *gopobj;
+       u32 bpix, col, row;
+       u64 fb_base, fb_size;
+       void *fb;
+       efi_status_t ret;
 
-       switch (panel_info.vl_bpix) {
+#ifdef CONFIG_DM_VIDEO
+       struct udevice *vdev;
+
+       /* We only support a single video output device for now */
+       if (uclass_first_device(UCLASS_VIDEO, &vdev) || !vdev)
+               return -1;
+
+       struct video_priv *priv = dev_get_uclass_priv(vdev);
+       bpix = priv->bpix;
+       col = video_get_xsize(vdev);
+       row = video_get_ysize(vdev);
+       fb_base = (uintptr_t)priv->fb;
+       fb_size = priv->fb_size;
+       fb = priv->fb;
+#else
+       int line_len;
+
+       bpix = panel_info.vl_bpix;
+       col = panel_info.vl_col;
+       row = panel_info.vl_row;
+       fb_base = gd->fb_base;
+       fb_size = lcd_get_size(&line_len);
+       fb = (void*)gd->fb_base;
+#endif
+
+       switch (bpix) {
+#ifdef CONFIG_DM_VIDEO
+       case VIDEO_BPP16:
+       case VIDEO_BPP32:
+#else
        case LCD_COLOR32:
        case LCD_COLOR16:
+#endif
                break;
        default:
                /* So far, we only work in 16 or 32 bit mode */
@@ -122,11 +174,23 @@ int efi_gop_register(void)
        }
 
        gopobj = calloc(1, sizeof(*gopobj));
+       if (!gopobj) {
+               printf("ERROR: Out of memory\n");
+               return 1;
+       }
+
+       /* Hook up to the device list */
+       INIT_LIST_HEAD(&gopobj->parent.protocols);
+       list_add_tail(&gopobj->parent.link, &efi_obj_list);
 
        /* Fill in object data */
-       gopobj->parent.protocols[0].guid = &efi_gop_guid;
-       gopobj->parent.protocols[0].open = efi_return_handle;
        gopobj->parent.handle = &gopobj->ops;
+       ret = efi_add_protocol(gopobj->parent.handle, &efi_gop_guid,
+                              &gopobj->ops);
+       if (ret != EFI_SUCCESS) {
+               printf("ERROR: Out of memory\n");
+               return 1;
+       }
        gopobj->ops.query_mode = gop_query_mode;
        gopobj->ops.set_mode = gop_set_mode;
        gopobj->ops.blt = gop_blt;
@@ -136,14 +200,24 @@ int efi_gop_register(void)
        gopobj->mode.info = &gopobj->info;
        gopobj->mode.info_size = sizeof(gopobj->info);
 
+#ifdef CONFIG_DM_VIDEO
+       if (bpix == VIDEO_BPP32) {
+#else
+       if (bpix == LCD_COLOR32) {
+#endif
+               /* With 32bit color space we can directly expose the fb */
+               gopobj->mode.fb_base = fb_base;
+               gopobj->mode.fb_size = fb_size;
+       }
+
        gopobj->info.version = 0;
-       gopobj->info.width = panel_info.vl_col;
-       gopobj->info.height = panel_info.vl_row;
+       gopobj->info.width = col;
+       gopobj->info.height = row;
        gopobj->info.pixel_format = EFI_GOT_RGBA8;
-       gopobj->info.pixels_per_scanline = panel_info.vl_col;
+       gopobj->info.pixels_per_scanline = col;
 
-       /* Hook up to the device list */
-       list_add_tail(&gopobj->parent.link, &efi_obj_list);
+       gopobj->bpix = bpix;
+       gopobj->fb = fb;
 
        return 0;
 }