Subversion Repositories Kolibri OS

/*

 * Copyright 2007-8 Advanced Micro Devices, Inc.

 * Copyright 2008 Red Hat Inc.

 *

 * 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 COPYRIGHT HOLDER(S) OR AUTHOR(S) 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: Dave Airlie

 *          Alex Deucher

 */

#include "drmP.h"

#include "drm_edid.h"

#include "drm_crtc_helper.h"

#include "radeon_drm.h"

#include "radeon.h"

extern void

radeon_combios_connected_scratch_regs(struct drm_connector *connector,

				      struct drm_encoder *encoder,

				      bool connected);

extern void

radeon_atombios_connected_scratch_regs(struct drm_connector *connector,

				       struct drm_encoder *encoder,

				       bool connected);

static void

radeon_connector_update_scratch_regs(struct drm_connector *connector, enum drm_connector_status status)

{

	struct drm_device *dev = connector->dev;

	struct radeon_device *rdev = dev->dev_private;

	struct drm_encoder *best_encoder = NULL;

	struct drm_encoder *encoder = NULL;

	struct drm_connector_helper_funcs *connector_funcs = connector->helper_private;

	struct drm_mode_object *obj;

	bool connected;

	int i;

	best_encoder = connector_funcs->best_encoder(connector);

	for (i = 0; i < DRM_CONNECTOR_MAX_ENCODER; i++) {

		if (connector->encoder_ids[i] == 0)

			break;

		obj = drm_mode_object_find(connector->dev,

					   connector->encoder_ids[i],

					   DRM_MODE_OBJECT_ENCODER);

		if (!obj)

			continue;

		encoder = obj_to_encoder(obj);

		if ((encoder == best_encoder) && (status == connector_status_connected))

			connected = true;

		else

			connected = false;

		if (rdev->is_atom_bios)

			radeon_atombios_connected_scratch_regs(connector, encoder, connected);

		else

			radeon_combios_connected_scratch_regs(connector, encoder, connected);

	}

}

struct drm_encoder *radeon_best_single_encoder(struct drm_connector *connector)

{

	int enc_id = connector->encoder_ids[0];

	struct drm_mode_object *obj;

	struct drm_encoder *encoder;

    ENTRY();

	/* pick the encoder ids */

	if (enc_id) {

		obj = drm_mode_object_find(connector->dev, enc_id, DRM_MODE_OBJECT_ENCODER);

		if (!obj)

			return NULL;

		encoder = obj_to_encoder(obj);

		return encoder;

	}

	return NULL;

}

static struct drm_display_mode *radeon_fp_native_mode(struct drm_encoder *encoder)

{

	struct drm_device *dev = encoder->dev;

	struct radeon_encoder *radeon_encoder = to_radeon_encoder(encoder);

	struct drm_display_mode *mode = NULL;

	struct radeon_native_mode *native_mode = &radeon_encoder->native_mode;

	if (native_mode->panel_xres != 0 &&

	    native_mode->panel_yres != 0 &&

	    native_mode->dotclock != 0) {

		mode = drm_mode_create(dev);

		mode->hdisplay = native_mode->panel_xres;

		mode->vdisplay = native_mode->panel_yres;

		mode->htotal = mode->hdisplay + native_mode->hblank;

		mode->hsync_start = mode->hdisplay + native_mode->hoverplus;

		mode->hsync_end = mode->hsync_start + native_mode->hsync_width;

		mode->vtotal = mode->vdisplay + native_mode->vblank;

		mode->vsync_start = mode->vdisplay + native_mode->voverplus;

		mode->vsync_end = mode->vsync_start + native_mode->vsync_width;

		mode->clock = native_mode->dotclock;

		mode->flags = 0;

		mode->type = DRM_MODE_TYPE_PREFERRED | DRM_MODE_TYPE_DRIVER;

		drm_mode_set_name(mode);

		DRM_DEBUG("Adding native panel mode %s\n", mode->name);

	}

	return mode;

}

int radeon_connector_set_property(struct drm_connector *connector, struct drm_property *property,

				  uint64_t val)

{

	return 0;

}

static int radeon_lvds_get_modes(struct drm_connector *connector)

{

	struct radeon_connector *radeon_connector = to_radeon_connector(connector);

	struct drm_encoder *encoder;

	int ret = 0;

	struct drm_display_mode *mode;

	if (radeon_connector->ddc_bus) {

		ret = radeon_ddc_get_modes(radeon_connector);

		if (ret > 0) {

			return ret;

		}

	}

	encoder = radeon_best_single_encoder(connector);

	if (!encoder)

		return 0;

	/* we have no EDID modes */

	mode = radeon_fp_native_mode(encoder);

	if (mode) {

		ret = 1;

		drm_mode_probed_add(connector, mode);

	}

	return ret;

}

static int radeon_lvds_mode_valid(struct drm_connector *connector,

				  struct drm_display_mode *mode)

{

	return MODE_OK;

}

static enum drm_connector_status radeon_lvds_detect(struct drm_connector *connector)

{

	enum drm_connector_status ret = connector_status_connected;

	/* check acpi lid status ??? */

	radeon_connector_update_scratch_regs(connector, ret);

	return ret;

}

static void radeon_connector_destroy(struct drm_connector *connector)

{

	struct radeon_connector *radeon_connector = to_radeon_connector(connector);

	if (radeon_connector->ddc_bus)

		radeon_i2c_destroy(radeon_connector->ddc_bus);

	kfree(radeon_connector->con_priv);

  // drm_sysfs_connector_remove(connector);

	drm_connector_cleanup(connector);

	kfree(connector);

}

struct drm_connector_helper_funcs radeon_lvds_connector_helper_funcs = {

	.get_modes = radeon_lvds_get_modes,

	.mode_valid = radeon_lvds_mode_valid,

	.best_encoder = radeon_best_single_encoder,

};

struct drm_connector_funcs radeon_lvds_connector_funcs = {

	.dpms = drm_helper_connector_dpms,

	.detect = radeon_lvds_detect,

	.fill_modes = drm_helper_probe_single_connector_modes,

	.destroy = radeon_connector_destroy,

	.set_property = radeon_connector_set_property,

};

static int radeon_vga_get_modes(struct drm_connector *connector)

{

	struct radeon_connector *radeon_connector = to_radeon_connector(connector);

	int ret;

	ret = radeon_ddc_get_modes(radeon_connector);

	return ret;

}

static int radeon_vga_mode_valid(struct drm_connector *connector,

				  struct drm_display_mode *mode)

{

	return MODE_OK;

}

static enum drm_connector_status radeon_vga_detect(struct drm_connector *connector)

{

	struct radeon_connector *radeon_connector = to_radeon_connector(connector);

	struct drm_encoder *encoder;

	struct drm_encoder_helper_funcs *encoder_funcs;

	bool dret;

	enum drm_connector_status ret = connector_status_disconnected;

	radeon_i2c_do_lock(radeon_connector, 1);

	dret = radeon_ddc_probe(radeon_connector);

	radeon_i2c_do_lock(radeon_connector, 0);

	if (dret)

		ret = connector_status_connected;

	else {

		/* if EDID fails to a load detect */

		encoder = radeon_best_single_encoder(connector);

		if (!encoder)

			ret = connector_status_disconnected;

		else {

			encoder_funcs = encoder->helper_private;

			ret = encoder_funcs->detect(encoder, connector);

		}

	}

	radeon_connector_update_scratch_regs(connector, ret);

	return ret;

}

struct drm_connector_helper_funcs radeon_vga_connector_helper_funcs = {

	.get_modes = radeon_vga_get_modes,

	.mode_valid = radeon_vga_mode_valid,

	.best_encoder = radeon_best_single_encoder,

};

struct drm_connector_funcs radeon_vga_connector_funcs = {

	.dpms = drm_helper_connector_dpms,

	.detect = radeon_vga_detect,

	.fill_modes = drm_helper_probe_single_connector_modes,

	.destroy = radeon_connector_destroy,

	.set_property = radeon_connector_set_property,

};

static int radeon_dvi_get_modes(struct drm_connector *connector)

{

	struct radeon_connector *radeon_connector = to_radeon_connector(connector);

	int ret;

	ret = radeon_ddc_get_modes(radeon_connector);

	/* reset scratch regs here since radeon_dvi_detect doesn't check digital bit */

	radeon_connector_update_scratch_regs(connector, connector_status_connected);

	return ret;

}

static enum drm_connector_status radeon_dvi_detect(struct drm_connector *connector)

{

	struct radeon_connector *radeon_connector = to_radeon_connector(connector);

	struct drm_encoder *encoder;

	struct drm_encoder_helper_funcs *encoder_funcs;

	struct drm_mode_object *obj;

	int i;

	enum drm_connector_status ret = connector_status_disconnected;

	bool dret;

	radeon_i2c_do_lock(radeon_connector, 1);

	dret = radeon_ddc_probe(radeon_connector);

	radeon_i2c_do_lock(radeon_connector, 0);

	if (dret)

		ret = connector_status_connected;

	else {

		for (i = 0; i < DRM_CONNECTOR_MAX_ENCODER; i++) {

			if (connector->encoder_ids[i] == 0)

				break;

			obj = drm_mode_object_find(connector->dev,

						   connector->encoder_ids[i],

						   DRM_MODE_OBJECT_ENCODER);

			if (!obj)

				continue;

			encoder = obj_to_encoder(obj);

			encoder_funcs = encoder->helper_private;

			if (encoder_funcs->detect) {

				ret = encoder_funcs->detect(encoder, connector);

				if (ret == connector_status_connected) {

					radeon_connector->use_digital = 0;

					break;

				}

			}

		}

	}

	/* updated in get modes as well since we need to know if it's analog or digital */

	radeon_connector_update_scratch_regs(connector, ret);

	return ret;

}

/* okay need to be smart in here about which encoder to pick */

struct drm_encoder *radeon_dvi_encoder(struct drm_connector *connector)

{

	int enc_id = connector->encoder_ids[0];

	struct radeon_connector *radeon_connector = to_radeon_connector(connector);

	struct drm_mode_object *obj;

	struct drm_encoder *encoder;

	int i;

    ENTRY();

	for (i = 0; i < DRM_CONNECTOR_MAX_ENCODER; i++) {

		if (connector->encoder_ids[i] == 0)

			break;

		obj = drm_mode_object_find(connector->dev, connector->encoder_ids[i], DRM_MODE_OBJECT_ENCODER);

		if (!obj)

			continue;

		encoder = obj_to_encoder(obj);

		if (radeon_connector->use_digital) {

			if (encoder->encoder_type == DRM_MODE_ENCODER_TMDS)

				return encoder;

		} else {

			if (encoder->encoder_type == DRM_MODE_ENCODER_DAC ||

			    encoder->encoder_type == DRM_MODE_ENCODER_TVDAC)

				return encoder;

		}

	}

	/* see if we have a default encoder  TODO */

	/* then check use digitial */

	/* pick the first one */

	if (enc_id) {

		obj = drm_mode_object_find(connector->dev, enc_id, DRM_MODE_OBJECT_ENCODER);

		if (!obj)

			return NULL;

		encoder = obj_to_encoder(obj);

		return encoder;

	}

	return NULL;

}

struct drm_connector_helper_funcs radeon_dvi_connector_helper_funcs = {

	.get_modes = radeon_dvi_get_modes,

	.mode_valid = radeon_vga_mode_valid,

	.best_encoder = radeon_dvi_encoder,

};

struct drm_connector_funcs radeon_dvi_connector_funcs = {

	.dpms = drm_helper_connector_dpms,

	.detect = radeon_dvi_detect,

	.fill_modes = drm_helper_probe_single_connector_modes,

	.set_property = radeon_connector_set_property,

	.destroy = radeon_connector_destroy,

};

void

radeon_add_atom_connector(struct drm_device *dev,

			  uint32_t connector_id,

			  uint32_t supported_device,

			  int connector_type,

			  struct radeon_i2c_bus_rec *i2c_bus,

			  bool linkb,

			  uint32_t igp_lane_info)

{

	struct drm_connector *connector;

	struct radeon_connector *radeon_connector;

	struct radeon_connector_atom_dig *radeon_dig_connector;

	uint32_t subpixel_order = SubPixelNone;

	/* fixme - tv/cv/din */

	if ((connector_type == DRM_MODE_CONNECTOR_Unknown) ||

	    (connector_type == DRM_MODE_CONNECTOR_SVIDEO) ||

	    (connector_type == DRM_MODE_CONNECTOR_Composite) ||

	    (connector_type == DRM_MODE_CONNECTOR_9PinDIN))

		return;

	/* see if we already added it */

	list_for_each_entry(connector, &dev->mode_config.connector_list, head) {

		radeon_connector = to_radeon_connector(connector);

		if (radeon_connector->connector_id == connector_id) {

			radeon_connector->devices |= supported_device;

			return;

		}

	}

	radeon_connector = kzalloc(sizeof(struct radeon_connector), GFP_KERNEL);

	if (!radeon_connector)

		return;

	connector = &radeon_connector->base;

	radeon_connector->connector_id = connector_id;

	radeon_connector->devices = supported_device;

	switch (connector_type) {

	case DRM_MODE_CONNECTOR_VGA:

		drm_connector_init(dev, &radeon_connector->base, &radeon_vga_connector_funcs, connector_type);

		drm_connector_helper_add(&radeon_connector->base, &radeon_vga_connector_helper_funcs);

		if (i2c_bus->valid) {

			radeon_connector->ddc_bus = radeon_i2c_create(dev, i2c_bus, "VGA");

			if (!radeon_connector->ddc_bus)

				goto failed;

		}

		break;

	case DRM_MODE_CONNECTOR_DVIA:

		drm_connector_init(dev, &radeon_connector->base, &radeon_vga_connector_funcs, connector_type);

		drm_connector_helper_add(&radeon_connector->base, &radeon_vga_connector_helper_funcs);

		if (i2c_bus->valid) {

			radeon_connector->ddc_bus = radeon_i2c_create(dev, i2c_bus, "DVI");

			if (!radeon_connector->ddc_bus)

				goto failed;

		}

		break;

	case DRM_MODE_CONNECTOR_DVII:

	case DRM_MODE_CONNECTOR_DVID:

		radeon_dig_connector = kzalloc(sizeof(struct radeon_connector_atom_dig), GFP_KERNEL);

		if (!radeon_dig_connector)

			goto failed;

		radeon_dig_connector->linkb = linkb;

		radeon_dig_connector->igp_lane_info = igp_lane_info;

		radeon_connector->con_priv = radeon_dig_connector;

		drm_connector_init(dev, &radeon_connector->base, &radeon_dvi_connector_funcs, connector_type);

		drm_connector_helper_add(&radeon_connector->base, &radeon_dvi_connector_helper_funcs);

		if (i2c_bus->valid) {

			radeon_connector->ddc_bus = radeon_i2c_create(dev, i2c_bus, "DVI");

			if (!radeon_connector->ddc_bus)

				goto failed;

		}

		subpixel_order = SubPixelHorizontalRGB;

		break;

	case DRM_MODE_CONNECTOR_HDMIA:

	case DRM_MODE_CONNECTOR_HDMIB:

		radeon_dig_connector = kzalloc(sizeof(struct radeon_connector_atom_dig), GFP_KERNEL);

		if (!radeon_dig_connector)

			goto failed;

		radeon_dig_connector->linkb = linkb;

		radeon_dig_connector->igp_lane_info = igp_lane_info;

		radeon_connector->con_priv = radeon_dig_connector;

		drm_connector_init(dev, &radeon_connector->base, &radeon_dvi_connector_funcs, connector_type);

		drm_connector_helper_add(&radeon_connector->base, &radeon_dvi_connector_helper_funcs);

		if (i2c_bus->valid) {

			radeon_connector->ddc_bus = radeon_i2c_create(dev, i2c_bus, "HDMI");

			if (!radeon_connector->ddc_bus)

				goto failed;

		}

		subpixel_order = SubPixelHorizontalRGB;

		break;

	case DRM_MODE_CONNECTOR_DisplayPort:

		radeon_dig_connector = kzalloc(sizeof(struct radeon_connector_atom_dig), GFP_KERNEL);

		if (!radeon_dig_connector)

			goto failed;

		radeon_dig_connector->linkb = linkb;

		radeon_dig_connector->igp_lane_info = igp_lane_info;

		radeon_connector->con_priv = radeon_dig_connector;

		drm_connector_init(dev, &radeon_connector->base, &radeon_dvi_connector_funcs, connector_type);

		drm_connector_helper_add(&radeon_connector->base, &radeon_dvi_connector_helper_funcs);

		if (i2c_bus->valid) {

			radeon_connector->ddc_bus = radeon_i2c_create(dev, i2c_bus, "DP");

			if (!radeon_connector->ddc_bus)

				goto failed;

		}

		subpixel_order = SubPixelHorizontalRGB;

		break;

	case DRM_MODE_CONNECTOR_SVIDEO:

	case DRM_MODE_CONNECTOR_Composite:

	case DRM_MODE_CONNECTOR_9PinDIN:

		break;

	case DRM_MODE_CONNECTOR_LVDS:

		radeon_dig_connector = kzalloc(sizeof(struct radeon_connector_atom_dig), GFP_KERNEL);

		if (!radeon_dig_connector)

			goto failed;

		radeon_dig_connector->linkb = linkb;

		radeon_dig_connector->igp_lane_info = igp_lane_info;

		radeon_connector->con_priv = radeon_dig_connector;

		drm_connector_init(dev, &radeon_connector->base, &radeon_lvds_connector_funcs, connector_type);

		drm_connector_helper_add(&radeon_connector->base, &radeon_lvds_connector_helper_funcs);

		if (i2c_bus->valid) {

			radeon_connector->ddc_bus = radeon_i2c_create(dev, i2c_bus, "LVDS");

			if (!radeon_connector->ddc_bus)

				goto failed;

		}

		subpixel_order = SubPixelHorizontalRGB;

		break;

	}

	connector->display_info.subpixel_order = subpixel_order;

 //  drm_sysfs_connector_add(connector);

	return;

failed:

	if (radeon_connector->ddc_bus)

		radeon_i2c_destroy(radeon_connector->ddc_bus);

	drm_connector_cleanup(connector);

	kfree(connector);

}

void

radeon_add_legacy_connector(struct drm_device *dev,

			    uint32_t connector_id,

			    uint32_t supported_device,

			    int connector_type,

			    struct radeon_i2c_bus_rec *i2c_bus)

{

	struct drm_connector *connector;

	struct radeon_connector *radeon_connector;

	uint32_t subpixel_order = SubPixelNone;

	/* fixme - tv/cv/din */

	if ((connector_type == DRM_MODE_CONNECTOR_Unknown) ||

	    (connector_type == DRM_MODE_CONNECTOR_SVIDEO) ||

	    (connector_type == DRM_MODE_CONNECTOR_Composite) ||

	    (connector_type == DRM_MODE_CONNECTOR_9PinDIN))

		return;

	/* see if we already added it */

	list_for_each_entry(connector, &dev->mode_config.connector_list, head) {

		radeon_connector = to_radeon_connector(connector);

		if (radeon_connector->connector_id == connector_id) {

			radeon_connector->devices |= supported_device;

			return;

		}

	}

	radeon_connector = kzalloc(sizeof(struct radeon_connector), GFP_KERNEL);

	if (!radeon_connector)

		return;

	connector = &radeon_connector->base;

	radeon_connector->connector_id = connector_id;

	radeon_connector->devices = supported_device;

	switch (connector_type) {

	case DRM_MODE_CONNECTOR_VGA:

		drm_connector_init(dev, &radeon_connector->base, &radeon_vga_connector_funcs, connector_type);

		drm_connector_helper_add(&radeon_connector->base, &radeon_vga_connector_helper_funcs);

		if (i2c_bus->valid) {

			radeon_connector->ddc_bus = radeon_i2c_create(dev, i2c_bus, "VGA");

			if (!radeon_connector->ddc_bus)

				goto failed;

		}

		break;

	case DRM_MODE_CONNECTOR_DVIA:

		drm_connector_init(dev, &radeon_connector->base, &radeon_vga_connector_funcs, connector_type);

		drm_connector_helper_add(&radeon_connector->base, &radeon_vga_connector_helper_funcs);

		if (i2c_bus->valid) {

			radeon_connector->ddc_bus = radeon_i2c_create(dev, i2c_bus, "DVI");

			if (!radeon_connector->ddc_bus)

				goto failed;

		}

		break;

	case DRM_MODE_CONNECTOR_DVII:

	case DRM_MODE_CONNECTOR_DVID:

		drm_connector_init(dev, &radeon_connector->base, &radeon_dvi_connector_funcs, connector_type);

		drm_connector_helper_add(&radeon_connector->base, &radeon_dvi_connector_helper_funcs);

		if (i2c_bus->valid) {

			radeon_connector->ddc_bus = radeon_i2c_create(dev, i2c_bus, "DVI");

			if (!radeon_connector->ddc_bus)

				goto failed;

		}

		subpixel_order = SubPixelHorizontalRGB;

		break;

	case DRM_MODE_CONNECTOR_SVIDEO:

	case DRM_MODE_CONNECTOR_Composite:

	case DRM_MODE_CONNECTOR_9PinDIN:

		break;

	case DRM_MODE_CONNECTOR_LVDS:

		drm_connector_init(dev, &radeon_connector->base, &radeon_lvds_connector_funcs, connector_type);

		drm_connector_helper_add(&radeon_connector->base, &radeon_lvds_connector_helper_funcs);

		if (i2c_bus->valid) {

			radeon_connector->ddc_bus = radeon_i2c_create(dev, i2c_bus, "LVDS");

			if (!radeon_connector->ddc_bus)

				goto failed;

		}

		subpixel_order = SubPixelHorizontalRGB;

		break;

	}

	connector->display_info.subpixel_order = subpixel_order;

  // drm_sysfs_connector_add(connector);

	return;

failed:

	if (radeon_connector->ddc_bus)

		radeon_i2c_destroy(radeon_connector->ddc_bus);

	drm_connector_cleanup(connector);

	kfree(connector);

}