Commit 43858eb4 authored by Thomas Zimmermann's avatar Thomas Zimmermann

drm/udl: Various improvements to the connector

Add style fixes, better error handling and reporting, and minor
clean-up changes to the connector code before moving the code to
the rest of the modesetting pipeline.
Signed-off-by: default avatarThomas Zimmermann <tzimmermann@suse.de>
Reviewed-by: default avatarJavier Martinez Canillas <javierm@redhat.com>
Link: https://patchwork.freedesktop.org/patch/msgid/20221006095355.23579-5-tzimmermann@suse.de
parent 2c1eafc4
...@@ -15,56 +15,64 @@ ...@@ -15,56 +15,64 @@
#include "udl_connector.h" #include "udl_connector.h"
#include "udl_drv.h" #include "udl_drv.h"
static int udl_get_edid_block(void *data, u8 *buf, unsigned int block, static int udl_get_edid_block(void *data, u8 *buf, unsigned int block, size_t len)
size_t len)
{ {
int ret, i;
u8 *read_buff;
struct udl_device *udl = data; struct udl_device *udl = data;
struct drm_device *dev = &udl->drm;
struct usb_device *udev = udl_to_usb_device(udl); struct usb_device *udev = udl_to_usb_device(udl);
u8 *read_buff;
int ret;
size_t i;
read_buff = kmalloc(2, GFP_KERNEL); read_buff = kmalloc(2, GFP_KERNEL);
if (!read_buff) if (!read_buff)
return -1; return -ENOMEM;
for (i = 0; i < len; i++) { for (i = 0; i < len; i++) {
int bval = (i + block * EDID_LENGTH) << 8; int bval = (i + block * EDID_LENGTH) << 8;
ret = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0), ret = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0),
0x02, (0x80 | (0x02 << 5)), bval, 0x02, (0x80 | (0x02 << 5)), bval,
0xA1, read_buff, 2, USB_CTRL_GET_TIMEOUT); 0xA1, read_buff, 2, USB_CTRL_GET_TIMEOUT);
if (ret < 1) { if (ret < 0) {
DRM_ERROR("Read EDID byte %d failed err %x\n", i, ret); drm_err(dev, "Read EDID byte %zu failed err %x\n", i, ret);
kfree(read_buff); goto err_kfree;
return -1; } else if (ret < 1) {
ret = -EIO;
drm_err(dev, "Read EDID byte %zu failed\n", i);
goto err_kfree;
} }
buf[i] = read_buff[1]; buf[i] = read_buff[1];
} }
kfree(read_buff); kfree(read_buff);
return 0; return 0;
err_kfree:
kfree(read_buff);
return ret;
} }
static int udl_get_modes(struct drm_connector *connector) static int udl_connector_helper_get_modes(struct drm_connector *connector)
{ {
struct udl_connector *udl_connector = to_udl_connector(connector); struct udl_connector *udl_connector = to_udl_connector(connector);
drm_connector_update_edid_property(connector, udl_connector->edid); drm_connector_update_edid_property(connector, udl_connector->edid);
if (udl_connector->edid) if (udl_connector->edid)
return drm_add_edid_modes(connector, udl_connector->edid); return drm_add_edid_modes(connector, udl_connector->edid);
return 0; return 0;
} }
static enum drm_connector_status static enum drm_connector_status udl_connector_detect(struct drm_connector *connector, bool force)
udl_detect(struct drm_connector *connector, bool force)
{ {
struct udl_device *udl = to_udl(connector->dev); struct udl_device *udl = to_udl(connector->dev);
struct udl_connector *udl_connector = to_udl_connector(connector); struct udl_connector *udl_connector = to_udl_connector(connector);
/* cleanup previous edid */ /* cleanup previous EDID */
if (udl_connector->edid != NULL) { kfree(udl_connector->edid);
kfree(udl_connector->edid);
udl_connector->edid = NULL;
}
udl_connector->edid = drm_do_get_edid(connector, udl_get_edid_block, udl); udl_connector->edid = drm_do_get_edid(connector, udl_get_edid_block, udl);
if (!udl_connector->edid) if (!udl_connector->edid)
...@@ -79,38 +87,46 @@ static void udl_connector_destroy(struct drm_connector *connector) ...@@ -79,38 +87,46 @@ static void udl_connector_destroy(struct drm_connector *connector)
drm_connector_cleanup(connector); drm_connector_cleanup(connector);
kfree(udl_connector->edid); kfree(udl_connector->edid);
kfree(connector); kfree(udl_connector);
} }
static const struct drm_connector_helper_funcs udl_connector_helper_funcs = { static const struct drm_connector_helper_funcs udl_connector_helper_funcs = {
.get_modes = udl_get_modes, .get_modes = udl_connector_helper_get_modes,
}; };
static const struct drm_connector_funcs udl_connector_funcs = { static const struct drm_connector_funcs udl_connector_funcs = {
.reset = drm_atomic_helper_connector_reset, .reset = drm_atomic_helper_connector_reset,
.detect = udl_detect, .detect = udl_connector_detect,
.fill_modes = drm_helper_probe_single_connector_modes, .fill_modes = drm_helper_probe_single_connector_modes,
.destroy = udl_connector_destroy, .destroy = udl_connector_destroy,
.atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state, .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
.atomic_destroy_state = drm_atomic_helper_connector_destroy_state, .atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
}; };
struct drm_connector *udl_connector_init(struct drm_device *dev) struct drm_connector *udl_connector_init(struct drm_device *dev)
{ {
struct udl_connector *udl_connector; struct udl_connector *udl_connector;
struct drm_connector *connector; struct drm_connector *connector;
int ret;
udl_connector = kzalloc(sizeof(*udl_connector), GFP_KERNEL); udl_connector = kzalloc(sizeof(*udl_connector), GFP_KERNEL);
if (!udl_connector) if (!udl_connector)
return ERR_PTR(-ENOMEM); return ERR_PTR(-ENOMEM);
connector = &udl_connector->connector; connector = &udl_connector->connector;
drm_connector_init(dev, connector, &udl_connector_funcs, ret = drm_connector_init(dev, connector, &udl_connector_funcs, DRM_MODE_CONNECTOR_VGA);
DRM_MODE_CONNECTOR_VGA); if (ret)
goto err_kfree;
drm_connector_helper_add(connector, &udl_connector_helper_funcs); drm_connector_helper_add(connector, &udl_connector_helper_funcs);
connector->polled = DRM_CONNECTOR_POLL_HPD | connector->polled = DRM_CONNECTOR_POLL_HPD |
DRM_CONNECTOR_POLL_CONNECT | DRM_CONNECTOR_POLL_DISCONNECT; DRM_CONNECTOR_POLL_CONNECT |
DRM_CONNECTOR_POLL_DISCONNECT;
return connector; return connector;
err_kfree:
kfree(udl_connector);
return ERR_PTR(ret);
} }
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment