* [PATCH 2/3] drm/loongson: Add GPIO and I2C driver for loongson drm.
@ 2021-06-05 6:20 lichenyang
0 siblings, 0 replies; 4+ messages in thread
From: lichenyang @ 2021-06-05 6:20 UTC (permalink / raw)
To: dri-devel
[-- Attachment #1: Type: text/plain, Size: 15537 bytes --]
Implement use GPIO and I2C driver to detect connector
and fetch EDID via DDC.
Signed-off-by: lichenyang <lichenyang@loongson.cn>
---
drivers/gpu/drm/loongson/Makefile | 3 +-
drivers/gpu/drm/loongson/loongson_connector.c | 70 ++++-
drivers/gpu/drm/loongson/loongson_drv.c | 16 +-
drivers/gpu/drm/loongson/loongson_drv.h | 10 +
drivers/gpu/drm/loongson/loongson_i2c.c | 280 ++++++++++++++++++
drivers/gpu/drm/loongson/loongson_i2c.h | 38 +++
6 files changed, 410 insertions(+), 7 deletions(-)
create mode 100644 drivers/gpu/drm/loongson/loongson_i2c.c
create mode 100644 drivers/gpu/drm/loongson/loongson_i2c.h
diff --git a/drivers/gpu/drm/loongson/Makefile b/drivers/gpu/drm/loongson/Makefile
index 22d063953b78..773b806e99a2 100644
--- a/drivers/gpu/drm/loongson/Makefile
+++ b/drivers/gpu/drm/loongson/Makefile
@@ -10,5 +10,6 @@ loongson-y := loongson_drv.o \
loongson_plane.o \
loongson_device.o \
loongson_connector.o \
- loongson_encoder.o
+ loongson_encoder.o \
+ loongson_i2c.o
obj-$(CONFIG_DRM_LOONGSON) += loongson.o
diff --git a/drivers/gpu/drm/loongson/loongson_connector.c b/drivers/gpu/drm/loongson/loongson_connector.c
index 6b1f0ffa33bd..2096a6ddc366 100644
--- a/drivers/gpu/drm/loongson/loongson_connector.c
+++ b/drivers/gpu/drm/loongson/loongson_connector.c
@@ -4,12 +4,65 @@
static int loongson_get_modes(struct drm_connector *connector)
{
- int count;
+ struct loongson_connector *lconnector;
+ struct i2c_adapter *adapter;
+ struct edid *edid = NULL;
+ u32 ret;
+
+ lconnector = to_loongson_connector(connector);
+ adapter = lconnector->i2c->adapter;
- count = drm_add_modes_noedid(connector, 1920, 1080);
- drm_set_preferred_mode(connector, 1024, 768);
+ if (adapter != NULL)
+ edid = drm_get_edid(connector, adapter);
+ else
+ DRM_DEBUG_KMS("get loongson connector adapter err\n");
- return count;
+ if (edid) {
+ drm_connector_update_edid_property(connector, edid);
+ ret = drm_add_edid_modes(connector, edid);
+ } else {
+ DRM_ERROR("Failed to read EDID\n");
+ ret = drm_add_modes_noedid(connector, 1024, 768);
+ }
+
+ return ret;
+}
+
+static bool is_connected(struct loongson_connector *ls_connector)
+{
+ unsigned char start = 0x0;
+ struct i2c_adapter *adapter;
+ struct i2c_msg msgs = {
+ .addr = DDC_ADDR,
+ .flags = 0,
+ .len = 1,
+ .buf = &start,
+ };
+
+ if (!ls_connector->i2c)
+ return false;
+
+ adapter = ls_connector->i2c->adapter;
+ if (i2c_transfer(adapter, &msgs, 1) != 1) {
+ DRM_DEBUG_KMS("display-%d not connect\n", ls_connector->id);
+ return false;
+ }
+
+ return true;
+}
+
+static enum drm_connector_status
+loongson_detect(struct drm_connector *connector, bool force)
+{
+ struct loongson_connector *lconnector;
+ enum drm_connector_status ret = connector_status_disconnected;
+
+ lconnector = to_loongson_connector(connector);
+
+ if (is_connected(lconnector))
+ ret = connector_status_connected;
+
+ return ret;
}
static const struct drm_connector_helper_funcs loongson_connector_helper = {
@@ -17,6 +70,7 @@ static const struct drm_connector_helper_funcs loongson_connector_helper = {
};
static const struct drm_connector_funcs loongson_connector_funcs = {
+ .detect = loongson_detect,
.fill_modes = drm_helper_probe_single_connector_modes,
.destroy = drm_connector_cleanup,
.reset = drm_atomic_helper_connector_reset,
@@ -37,11 +91,17 @@ int loongson_connector_init(struct loongson_device *ldev, int index)
lconnector->ldev = ldev;
lconnector->id = index;
+ lconnector->i2c_id = index + DC_I2C_BASE;
+
+ lconnector->i2c = loongson_i2c_bus_match(ldev, lconnector->i2c_id);
+ if (!lconnector->i2c)
+ DRM_INFO("connector-%d match i2c-%d err\n", index,
+ lconnector->i2c_id);
ldev->mode_info[index].connector = lconnector;
connector = &lconnector->base;
drm_connector_init(ldev->dev, connector, &loongson_connector_funcs,
- DRM_MODE_CONNECTOR_Unknown);
+ DRM_MODE_CONNECTOR_Unknown);
drm_connector_helper_add(connector, &loongson_connector_helper);
return 0;
diff --git a/drivers/gpu/drm/loongson/loongson_drv.c b/drivers/gpu/drm/loongson/loongson_drv.c
index e405199a3df6..252be9e25aff 100644
--- a/drivers/gpu/drm/loongson/loongson_drv.c
+++ b/drivers/gpu/drm/loongson/loongson_drv.c
@@ -11,9 +11,10 @@
/* Interface history:
* 0.1 - original.
+ * 0.2 - add i2c and connector detect.
*/
#define DRIVER_MAJOR 0
-#define DRIVER_MINOR 1
+#define DRIVER_MINOR 2
static const struct drm_mode_config_funcs loongson_mode_funcs = {
.fb_create = drm_gem_fb_create,
@@ -31,6 +32,7 @@ static int loongson_device_init(struct drm_device *dev, uint32_t flags)
resource_size_t aper_size;
resource_size_t mmio_base;
resource_size_t mmio_size;
+ u32 ret;
/* GPU MEM */
/* We need get 7A-gpu pci device information for ldev->gpu_pdev */
@@ -72,6 +74,18 @@ static int loongson_device_init(struct drm_device *dev, uint32_t flags)
if (ldev->io == NULL)
return -ENOMEM;
+ ret = loongson_dc_gpio_init(ldev);
+ if (ret) {
+ DRM_ERROR("Failed to initialize dc gpios\n");
+ return ret;
+ }
+
+ ret = loongson_i2c_init(ldev);
+ if (ret) {
+ DRM_ERROR("Failed to initialize dc i2c\n");
+ return ret;
+ }
+
DRM_INFO("DC mmio base 0x%llx size 0x%llx io 0x%llx\n",
mmio_base, mmio_size, *(u64 *)ldev->io);
DRM_INFO("GPU vram start = 0x%x size = 0x%x\n",
diff --git a/drivers/gpu/drm/loongson/loongson_drv.h b/drivers/gpu/drm/loongson/loongson_drv.h
index 498d1b082a19..24a534c3c79c 100644
--- a/drivers/gpu/drm/loongson/loongson_drv.h
+++ b/drivers/gpu/drm/loongson/loongson_drv.h
@@ -18,6 +18,7 @@
#include <drm/drm_crtc_helper.h>
#include <drm/drm_connector.h>
#include <drm/drm_encoder.h>
+#include "loongson_i2c.h"
/* General customization:
*/
@@ -28,6 +29,7 @@
#define to_loongson_crtc(x) container_of(x, struct loongson_crtc, base)
#define to_loongson_encoder(x) container_of(x, struct loongson_encoder, base)
+#define to_loongson_connector(x) container_of(x, struct loongson_connector, base)
#define LS7A_CHIPCFG_REG_BASE (0x10010000)
#define PCI_DEVICE_ID_LOONGSON_DC 0x7a06
@@ -92,8 +94,10 @@ struct loongson_encoder {
struct loongson_connector {
struct drm_connector base;
struct loongson_device *ldev;
+ struct loongson_i2c *i2c;
u16 id;
u32 type;
+ u16 i2c_id;
};
struct loongson_mode_info {
@@ -115,6 +119,9 @@ struct loongson_device {
u32 num_crtc;
struct loongson_mode_info mode_info[2];
struct pci_dev *gpu_pdev; /* LS7A gpu device info */
+
+ struct loongson_i2c i2c_bus[LS_MAX_I2C_BUS];
+ struct gpio_chip chip;
};
/* crtc */
@@ -129,6 +136,9 @@ int loongson_encoder_init(struct loongson_device *ldev, int index);
/* plane */
int loongson_plane_init(struct loongson_crtc *lcrtc);
+/* i2c */
+int loongson_dc_gpio_init(struct loongson_device *ldev);
+
/* device */
u32 loongson_gpu_offset(struct drm_plane_state *state);
u32 ls7a_mm_rreg(struct loongson_device *ldev, u32 offset);
diff --git a/drivers/gpu/drm/loongson/loongson_i2c.c b/drivers/gpu/drm/loongson/loongson_i2c.c
new file mode 100644
index 000000000000..ef06a6787e34
--- /dev/null
+++ b/drivers/gpu/drm/loongson/loongson_i2c.c
@@ -0,0 +1,280 @@
+// SPDX-License-Identifier: GPL-2.0-or-later
+
+#include "loongson_i2c.h"
+#include "loongson_drv.h"
+#include "linux/gpio.h"
+#include <linux/gpio/consumer.h>
+
+static struct gpio i2c_gpios[4] = {
+ { .gpio = DC_GPIO_0, .flags = GPIOF_OPEN_DRAIN, .label = "i2c-6-sda" },
+ { .gpio = DC_GPIO_1, .flags = GPIOF_OPEN_DRAIN, .label = "i2c-6-scl" },
+ { .gpio = DC_GPIO_2, .flags = GPIOF_OPEN_DRAIN, .label = "i2c-7-sda" },
+ { .gpio = DC_GPIO_3, .flags = GPIOF_OPEN_DRAIN, .label = "i2c-7-scl" },
+};
+
+static inline void __dc_gpio_set_dir(struct loongson_device *ldev,
+ unsigned int pin, int input)
+{
+ u32 temp;
+
+ temp = ls7a_mm_rreg(ldev, LS7A_DC_GPIO_CFG_OFFSET);
+
+ if (input)
+ temp |= 1UL << pin;
+ else
+ temp &= ~(1UL << pin);
+
+ ls7a_mm_wreg(ldev, LS7A_DC_GPIO_CFG_OFFSET, temp);
+}
+
+static void __dc_gpio_set_val(struct loongson_device *ldev,
+ unsigned int pin, int high)
+{
+ u32 temp;
+
+ temp = ls7a_mm_rreg(ldev, LS7A_DC_GPIO_OUT_OFFSET);
+
+ if (high)
+ temp |= 1UL << pin;
+ else
+ temp &= ~(1UL << pin);
+
+ ls7a_mm_wreg(ldev, LS7A_DC_GPIO_OUT_OFFSET, temp);
+}
+
+static int ls_dc_gpio_request(struct gpio_chip *chip, unsigned int pin)
+{
+ if (pin >= (chip->ngpio + chip->base))
+ return -EINVAL;
+ else
+ return 0;
+}
+
+static int ls_dc_gpio_dir_input(struct gpio_chip *chip, unsigned int pin)
+{
+ struct loongson_device *ldev;
+
+ ldev = container_of(chip, struct loongson_device, chip);
+ __dc_gpio_set_dir(ldev, pin, 1);
+
+ return 0;
+}
+
+static int ls_dc_gpio_dir_output(struct gpio_chip *chip,
+ unsigned int pin, int value)
+{
+ struct loongson_device *ldev;
+
+ ldev = container_of(chip, struct loongson_device, chip);
+ __dc_gpio_set_val(ldev, pin, value);
+ __dc_gpio_set_dir(ldev, pin, 0);
+
+ return 0;
+}
+
+static void ls_dc_gpio_set(struct gpio_chip *chip, unsigned int pin, int value)
+{
+ struct loongson_device *ldev;
+
+ ldev = container_of(chip, struct loongson_device, chip);
+ __dc_gpio_set_val(ldev, pin, value);
+}
+
+static int ls_dc_gpio_get(struct gpio_chip *chip, unsigned int pin)
+{
+ u32 val;
+ struct loongson_device *ldev;
+
+ ldev = container_of(chip, struct loongson_device, chip);
+ val = ls7a_mm_rreg(ldev, LS7A_DC_GPIO_IN_OFFSET);
+ return (val >> pin) & 1;
+}
+
+static void loongson_i2c_set_data(void *i2c, int value)
+{
+ struct loongson_i2c *li2c = i2c;
+ struct gpio_desc *gpiod = gpio_to_desc(i2c_gpios[li2c->data].gpio);
+
+ gpiod_set_value_cansleep(gpiod, value);
+}
+
+static void loongson_i2c_set_clock(void *i2c, int value)
+{
+ struct loongson_i2c *li2c = i2c;
+ struct gpio_desc *gpiod = gpio_to_desc(i2c_gpios[li2c->clock].gpio);
+
+ gpiod_set_value_cansleep(gpiod, value);
+}
+
+static int loongson_i2c_get_data(void *i2c)
+{
+ struct loongson_i2c *li2c = i2c;
+ struct gpio_desc *gpiod = gpio_to_desc(i2c_gpios[li2c->data].gpio);
+
+ return gpiod_get_value_cansleep(gpiod);
+}
+
+static int loongson_i2c_get_clock(void *i2c)
+{
+ struct loongson_i2c *li2c = i2c;
+ struct gpio_desc *gpiod = gpio_to_desc(i2c_gpios[li2c->clock].gpio);
+
+ return gpiod_get_value_cansleep(gpiod);
+}
+
+static int loongson_i2c_create(struct loongson_i2c *li2c, const char *name)
+{
+ int ret;
+ unsigned int i2c_num;
+ struct i2c_client *i2c_cli;
+ struct i2c_adapter *i2c_adapter;
+ struct i2c_board_info i2c_info;
+ struct i2c_algo_bit_data *i2c_algo_data;
+ struct device *dev;
+
+ dev = &li2c->adapter->dev;
+ i2c_num = li2c->i2c_id;
+ i2c_adapter = kzalloc(sizeof(struct i2c_adapter), GFP_KERNEL);
+ if (IS_ERR(i2c_adapter)) {
+ ret = PTR_ERR(i2c_adapter);
+ goto error_mem;
+ }
+ i2c_algo_data = kzalloc(sizeof(struct i2c_algo_bit_data), GFP_KERNEL);
+ if (IS_ERR(i2c_algo_data)) {
+ ret = PTR_ERR(i2c_algo_data);
+ goto error_mem;
+ }
+
+ i2c_adapter->owner = THIS_MODULE;
+ i2c_adapter->class = I2C_CLASS_DDC;
+ i2c_adapter->algo_data = i2c_algo_data;
+ i2c_adapter->nr = i2c_num;
+ snprintf(i2c_adapter->name, sizeof(i2c_adapter->name), "%s%d",
+ name, i2c_num - DC_I2C_BASE);
+
+ li2c->data = i2c_num % DC_I2C_BASE * 2;
+ li2c->clock = i2c_num % DC_I2C_BASE * 2 + 1;
+ DRM_INFO("Created i2c-%d, sda=%d, scl=%d\n",
+ i2c_num, li2c->data, li2c->clock);
+
+ if (gpio_cansleep(i2c_gpios[li2c->data].gpio) ||
+ gpio_cansleep(i2c_gpios[li2c->clock].gpio))
+ dev_warn(dev, "Slow GPIO pins might wreak havoc I2C timing\n");
+
+ i2c_algo_data->setsda = loongson_i2c_set_data;
+ i2c_algo_data->setscl = loongson_i2c_set_clock;
+ i2c_algo_data->getsda = loongson_i2c_get_data;
+ i2c_algo_data->getscl = loongson_i2c_get_clock;
+ i2c_algo_data->udelay = DC_I2C_TON;
+ i2c_algo_data->timeout = usecs_to_jiffies(2200);
+
+ ret = i2c_bit_add_numbered_bus(i2c_adapter);
+ if (ret) {
+ DRM_ERROR("Failed to register i2c algo-bit adapter %s\n",
+ i2c_adapter->name);
+ kfree(i2c_adapter);
+ i2c_adapter = NULL;
+ }
+
+ li2c->adapter = i2c_adapter;
+ i2c_algo_data->data = li2c;
+ i2c_set_adapdata(li2c->adapter, li2c);
+ DRM_INFO("Register i2c algo-bit adapter [%s]\n", i2c_adapter->name);
+
+ memset(&i2c_info, 0, sizeof(struct i2c_board_info));
+ strncpy(i2c_info.type, name, I2C_NAME_SIZE);
+ i2c_info.addr = DDC_ADDR;
+ i2c_cli = i2c_new_client_device(i2c_adapter, &i2c_info);
+ if (i2c_cli == NULL) {
+ DRM_ERROR("Failed to create i2c adapter\n");
+ return -EBUSY;
+ }
+ li2c->init = true;
+ return 0;
+
+error_mem:
+ DRM_ERROR("Failed to malloc memory for loongson i2c\n");
+ return ret;
+}
+
+static int loongson_i2c_add(struct loongson_device *ldev, const char *name)
+{
+ int i;
+
+ for (i = 0; i < LS_MAX_I2C_BUS; i++) {
+ if (ldev->i2c_bus[i].use)
+ loongson_i2c_create(&ldev->i2c_bus[i], name);
+ else {
+ DRM_DEBUG_DRIVER("i2c_bus[%d] not use\n", i);
+ return -ENODEV;
+ }
+ }
+ return 0;
+}
+
+int loongson_dc_gpio_init(struct loongson_device *ldev)
+{
+ int ret;
+ struct gpio_chip *chip;
+
+ chip = &ldev->chip;
+ chip->label = "ls7a-dc-gpio";
+ chip->base = LS7A_DC_GPIO_BASE;
+ chip->ngpio = 4;
+ chip->parent = ldev->dev->dev;
+ chip->request = ls_dc_gpio_request;
+ chip->direction_input = ls_dc_gpio_dir_input;
+ chip->direction_output = ls_dc_gpio_dir_output;
+ chip->set = ls_dc_gpio_set;
+ chip->get = ls_dc_gpio_get;
+ chip->can_sleep = false;
+
+ ret = devm_gpiochip_add_data(ldev->dev->dev, chip, ldev);
+ if (ret) {
+ DRM_ERROR("Failed to register ls7a dc gpio driver\n");
+ return -ENODEV;
+ }
+ DRM_INFO("Registered ls7a dc gpio driver\n");
+
+ return 0;
+}
+
+int loongson_i2c_init(struct loongson_device *ldev)
+{
+ int ret;
+
+ ret = gpio_request_array(i2c_gpios, ARRAY_SIZE(i2c_gpios));
+ if (ret) {
+ DRM_ERROR("Failed to request gpio array i2c_gpios\n");
+ return -ENODEV;
+ }
+
+ ldev->i2c_bus[0].i2c_id = 6;
+ ldev->i2c_bus[0].use = true;
+ ldev->i2c_bus[1].i2c_id = 7;
+ ldev->i2c_bus[1].use = true;
+
+ loongson_i2c_add(ldev, DC_I2C_NAME);
+
+ return 0;
+}
+
+struct loongson_i2c *loongson_i2c_bus_match(struct loongson_device *ldev, u32 i2c_id)
+{
+ u32 i;
+ struct loongson_i2c *match = NULL, *tables;
+
+ tables = ldev->i2c_bus;
+
+ for (i = 0; i < LS_MAX_I2C_BUS; i++) {
+ if (tables->i2c_id == i2c_id && tables->init == true) {
+ match = tables;
+ break;
+ }
+
+ tables++;
+ }
+
+ return match;
+}
+
diff --git a/drivers/gpu/drm/loongson/loongson_i2c.h b/drivers/gpu/drm/loongson/loongson_i2c.h
new file mode 100644
index 000000000000..50d4d3f4b10f
--- /dev/null
+++ b/drivers/gpu/drm/loongson/loongson_i2c.h
@@ -0,0 +1,38 @@
+/* SPDX-License-Identifier: GPL-2.0-only */
+
+#ifndef __LOONGSON_I2C_H__
+#define __LOONGSON_I2C_H__
+
+#include <linux/i2c.h>
+#include <linux/i2c-algo-bit.h>
+#include <linux/gpio/driver.h>
+#include <drm/drm_edid.h>
+
+#define DC_I2C_TON 5
+#define DC_I2C_BASE 6
+#define DC_I2C_NAME "ls_dc_i2c"
+#define LS_MAX_I2C_BUS 16
+
+/* Loongson 7A display controller proprietary GPIOs */
+#define LS7A_DC_GPIO_BASE 73
+#define DC_GPIO_0 (73)
+#define DC_GPIO_1 (74)
+#define DC_GPIO_2 (75)
+#define DC_GPIO_3 (76)
+#define LS7A_DC_GPIO_CFG_OFFSET (0x1660)
+#define LS7A_DC_GPIO_IN_OFFSET (0x1650)
+#define LS7A_DC_GPIO_OUT_OFFSET (0x1650)
+
+struct loongson_device;
+struct loongson_i2c {
+ struct i2c_adapter *adapter;
+ u32 data, clock;
+ bool use, init;
+ u32 i2c_id;
+};
+
+struct loongson_i2c *loongson_i2c_bus_match(struct loongson_device *ldev,
+ u32 i2c_id);
+int loongson_i2c_init(struct loongson_device *ldev);
+
+#endif /* __LOONGSON_I2C_H__ */
--
2.31.1
[-- Attachment #2: Type: text/html, Size: 16094 bytes --]
^ permalink raw reply related [flat|nested] 4+ messages in thread
* [PATCH 2/3] drm/loongson: Add GPIO and I2C driver for loongson drm.
2021-07-06 6:36 [PATCH 1/3] drm/loongson: Add DRM Driver for Loongson 7A1000 bridge chip lichenyang
@ 2021-07-06 6:36 ` lichenyang
0 siblings, 0 replies; 4+ messages in thread
From: lichenyang @ 2021-07-06 6:36 UTC (permalink / raw)
To: devel
Implement use GPIO and I2C driver to detect connector
and fetch EDID via DDC.
Signed-off-by: lichenyang <lichenyang@loongson.cn>
---
drivers/gpu/drm/loongson/Makefile | 3 +-
drivers/gpu/drm/loongson/loongson_connector.c | 70 ++++-
drivers/gpu/drm/loongson/loongson_drv.c | 16 +-
drivers/gpu/drm/loongson/loongson_drv.h | 10 +
drivers/gpu/drm/loongson/loongson_i2c.c | 280 ++++++++++++++++++
drivers/gpu/drm/loongson/loongson_i2c.h | 38 +++
6 files changed, 410 insertions(+), 7 deletions(-)
create mode 100644 drivers/gpu/drm/loongson/loongson_i2c.c
create mode 100644 drivers/gpu/drm/loongson/loongson_i2c.h
diff --git a/drivers/gpu/drm/loongson/Makefile b/drivers/gpu/drm/loongson/Makefile
index 22d063953b78..773b806e99a2 100644
--- a/drivers/gpu/drm/loongson/Makefile
+++ b/drivers/gpu/drm/loongson/Makefile
@@ -10,5 +10,6 @@ loongson-y := loongson_drv.o \
loongson_plane.o \
loongson_device.o \
loongson_connector.o \
- loongson_encoder.o
+ loongson_encoder.o \
+ loongson_i2c.o
obj-$(CONFIG_DRM_LOONGSON) += loongson.o
diff --git a/drivers/gpu/drm/loongson/loongson_connector.c b/drivers/gpu/drm/loongson/loongson_connector.c
index 6b1f0ffa33bd..2096a6ddc366 100644
--- a/drivers/gpu/drm/loongson/loongson_connector.c
+++ b/drivers/gpu/drm/loongson/loongson_connector.c
@@ -4,12 +4,65 @@
static int loongson_get_modes(struct drm_connector *connector)
{
- int count;
+ struct loongson_connector *lconnector;
+ struct i2c_adapter *adapter;
+ struct edid *edid = NULL;
+ u32 ret;
+
+ lconnector = to_loongson_connector(connector);
+ adapter = lconnector->i2c->adapter;
- count = drm_add_modes_noedid(connector, 1920, 1080);
- drm_set_preferred_mode(connector, 1024, 768);
+ if (adapter != NULL)
+ edid = drm_get_edid(connector, adapter);
+ else
+ DRM_DEBUG_KMS("get loongson connector adapter err\n");
- return count;
+ if (edid) {
+ drm_connector_update_edid_property(connector, edid);
+ ret = drm_add_edid_modes(connector, edid);
+ } else {
+ DRM_ERROR("Failed to read EDID\n");
+ ret = drm_add_modes_noedid(connector, 1024, 768);
+ }
+
+ return ret;
+}
+
+static bool is_connected(struct loongson_connector *ls_connector)
+{
+ unsigned char start = 0x0;
+ struct i2c_adapter *adapter;
+ struct i2c_msg msgs = {
+ .addr = DDC_ADDR,
+ .flags = 0,
+ .len = 1,
+ .buf = &start,
+ };
+
+ if (!ls_connector->i2c)
+ return false;
+
+ adapter = ls_connector->i2c->adapter;
+ if (i2c_transfer(adapter, &msgs, 1) != 1) {
+ DRM_DEBUG_KMS("display-%d not connect\n", ls_connector->id);
+ return false;
+ }
+
+ return true;
+}
+
+static enum drm_connector_status
+loongson_detect(struct drm_connector *connector, bool force)
+{
+ struct loongson_connector *lconnector;
+ enum drm_connector_status ret = connector_status_disconnected;
+
+ lconnector = to_loongson_connector(connector);
+
+ if (is_connected(lconnector))
+ ret = connector_status_connected;
+
+ return ret;
}
static const struct drm_connector_helper_funcs loongson_connector_helper = {
@@ -17,6 +70,7 @@ static const struct drm_connector_helper_funcs loongson_connector_helper = {
};
static const struct drm_connector_funcs loongson_connector_funcs = {
+ .detect = loongson_detect,
.fill_modes = drm_helper_probe_single_connector_modes,
.destroy = drm_connector_cleanup,
.reset = drm_atomic_helper_connector_reset,
@@ -37,11 +91,17 @@ int loongson_connector_init(struct loongson_device *ldev, int index)
lconnector->ldev = ldev;
lconnector->id = index;
+ lconnector->i2c_id = index + DC_I2C_BASE;
+
+ lconnector->i2c = loongson_i2c_bus_match(ldev, lconnector->i2c_id);
+ if (!lconnector->i2c)
+ DRM_INFO("connector-%d match i2c-%d err\n", index,
+ lconnector->i2c_id);
ldev->mode_info[index].connector = lconnector;
connector = &lconnector->base;
drm_connector_init(ldev->dev, connector, &loongson_connector_funcs,
- DRM_MODE_CONNECTOR_Unknown);
+ DRM_MODE_CONNECTOR_Unknown);
drm_connector_helper_add(connector, &loongson_connector_helper);
return 0;
diff --git a/drivers/gpu/drm/loongson/loongson_drv.c b/drivers/gpu/drm/loongson/loongson_drv.c
index e405199a3df6..252be9e25aff 100644
--- a/drivers/gpu/drm/loongson/loongson_drv.c
+++ b/drivers/gpu/drm/loongson/loongson_drv.c
@@ -11,9 +11,10 @@
/* Interface history:
* 0.1 - original.
+ * 0.2 - add i2c and connector detect.
*/
#define DRIVER_MAJOR 0
-#define DRIVER_MINOR 1
+#define DRIVER_MINOR 2
static const struct drm_mode_config_funcs loongson_mode_funcs = {
.fb_create = drm_gem_fb_create,
@@ -31,6 +32,7 @@ static int loongson_device_init(struct drm_device *dev, uint32_t flags)
resource_size_t aper_size;
resource_size_t mmio_base;
resource_size_t mmio_size;
+ u32 ret;
/* GPU MEM */
/* We need get 7A-gpu pci device information for ldev->gpu_pdev */
@@ -72,6 +74,18 @@ static int loongson_device_init(struct drm_device *dev, uint32_t flags)
if (ldev->io == NULL)
return -ENOMEM;
+ ret = loongson_dc_gpio_init(ldev);
+ if (ret) {
+ DRM_ERROR("Failed to initialize dc gpios\n");
+ return ret;
+ }
+
+ ret = loongson_i2c_init(ldev);
+ if (ret) {
+ DRM_ERROR("Failed to initialize dc i2c\n");
+ return ret;
+ }
+
DRM_INFO("DC mmio base 0x%llx size 0x%llx io 0x%llx\n",
mmio_base, mmio_size, *(u64 *)ldev->io);
DRM_INFO("GPU vram start = 0x%x size = 0x%x\n",
diff --git a/drivers/gpu/drm/loongson/loongson_drv.h b/drivers/gpu/drm/loongson/loongson_drv.h
index 498d1b082a19..24a534c3c79c 100644
--- a/drivers/gpu/drm/loongson/loongson_drv.h
+++ b/drivers/gpu/drm/loongson/loongson_drv.h
@@ -18,6 +18,7 @@
#include <drm/drm_crtc_helper.h>
#include <drm/drm_connector.h>
#include <drm/drm_encoder.h>
+#include "loongson_i2c.h"
/* General customization:
*/
@@ -28,6 +29,7 @@
#define to_loongson_crtc(x) container_of(x, struct loongson_crtc, base)
#define to_loongson_encoder(x) container_of(x, struct loongson_encoder, base)
+#define to_loongson_connector(x) container_of(x, struct loongson_connector, base)
#define LS7A_CHIPCFG_REG_BASE (0x10010000)
#define PCI_DEVICE_ID_LOONGSON_DC 0x7a06
@@ -92,8 +94,10 @@ struct loongson_encoder {
struct loongson_connector {
struct drm_connector base;
struct loongson_device *ldev;
+ struct loongson_i2c *i2c;
u16 id;
u32 type;
+ u16 i2c_id;
};
struct loongson_mode_info {
@@ -115,6 +119,9 @@ struct loongson_device {
u32 num_crtc;
struct loongson_mode_info mode_info[2];
struct pci_dev *gpu_pdev; /* LS7A gpu device info */
+
+ struct loongson_i2c i2c_bus[LS_MAX_I2C_BUS];
+ struct gpio_chip chip;
};
/* crtc */
@@ -129,6 +136,9 @@ int loongson_encoder_init(struct loongson_device *ldev, int index);
/* plane */
int loongson_plane_init(struct loongson_crtc *lcrtc);
+/* i2c */
+int loongson_dc_gpio_init(struct loongson_device *ldev);
+
/* device */
u32 loongson_gpu_offset(struct drm_plane_state *state);
u32 ls7a_mm_rreg(struct loongson_device *ldev, u32 offset);
diff --git a/drivers/gpu/drm/loongson/loongson_i2c.c b/drivers/gpu/drm/loongson/loongson_i2c.c
new file mode 100644
index 000000000000..ef06a6787e34
--- /dev/null
+++ b/drivers/gpu/drm/loongson/loongson_i2c.c
@@ -0,0 +1,280 @@
+// SPDX-License-Identifier: GPL-2.0-or-later
+
+#include "loongson_i2c.h"
+#include "loongson_drv.h"
+#include "linux/gpio.h"
+#include <linux/gpio/consumer.h>
+
+static struct gpio i2c_gpios[4] = {
+ { .gpio = DC_GPIO_0, .flags = GPIOF_OPEN_DRAIN, .label = "i2c-6-sda" },
+ { .gpio = DC_GPIO_1, .flags = GPIOF_OPEN_DRAIN, .label = "i2c-6-scl" },
+ { .gpio = DC_GPIO_2, .flags = GPIOF_OPEN_DRAIN, .label = "i2c-7-sda" },
+ { .gpio = DC_GPIO_3, .flags = GPIOF_OPEN_DRAIN, .label = "i2c-7-scl" },
+};
+
+static inline void __dc_gpio_set_dir(struct loongson_device *ldev,
+ unsigned int pin, int input)
+{
+ u32 temp;
+
+ temp = ls7a_mm_rreg(ldev, LS7A_DC_GPIO_CFG_OFFSET);
+
+ if (input)
+ temp |= 1UL << pin;
+ else
+ temp &= ~(1UL << pin);
+
+ ls7a_mm_wreg(ldev, LS7A_DC_GPIO_CFG_OFFSET, temp);
+}
+
+static void __dc_gpio_set_val(struct loongson_device *ldev,
+ unsigned int pin, int high)
+{
+ u32 temp;
+
+ temp = ls7a_mm_rreg(ldev, LS7A_DC_GPIO_OUT_OFFSET);
+
+ if (high)
+ temp |= 1UL << pin;
+ else
+ temp &= ~(1UL << pin);
+
+ ls7a_mm_wreg(ldev, LS7A_DC_GPIO_OUT_OFFSET, temp);
+}
+
+static int ls_dc_gpio_request(struct gpio_chip *chip, unsigned int pin)
+{
+ if (pin >= (chip->ngpio + chip->base))
+ return -EINVAL;
+ else
+ return 0;
+}
+
+static int ls_dc_gpio_dir_input(struct gpio_chip *chip, unsigned int pin)
+{
+ struct loongson_device *ldev;
+
+ ldev = container_of(chip, struct loongson_device, chip);
+ __dc_gpio_set_dir(ldev, pin, 1);
+
+ return 0;
+}
+
+static int ls_dc_gpio_dir_output(struct gpio_chip *chip,
+ unsigned int pin, int value)
+{
+ struct loongson_device *ldev;
+
+ ldev = container_of(chip, struct loongson_device, chip);
+ __dc_gpio_set_val(ldev, pin, value);
+ __dc_gpio_set_dir(ldev, pin, 0);
+
+ return 0;
+}
+
+static void ls_dc_gpio_set(struct gpio_chip *chip, unsigned int pin, int value)
+{
+ struct loongson_device *ldev;
+
+ ldev = container_of(chip, struct loongson_device, chip);
+ __dc_gpio_set_val(ldev, pin, value);
+}
+
+static int ls_dc_gpio_get(struct gpio_chip *chip, unsigned int pin)
+{
+ u32 val;
+ struct loongson_device *ldev;
+
+ ldev = container_of(chip, struct loongson_device, chip);
+ val = ls7a_mm_rreg(ldev, LS7A_DC_GPIO_IN_OFFSET);
+ return (val >> pin) & 1;
+}
+
+static void loongson_i2c_set_data(void *i2c, int value)
+{
+ struct loongson_i2c *li2c = i2c;
+ struct gpio_desc *gpiod = gpio_to_desc(i2c_gpios[li2c->data].gpio);
+
+ gpiod_set_value_cansleep(gpiod, value);
+}
+
+static void loongson_i2c_set_clock(void *i2c, int value)
+{
+ struct loongson_i2c *li2c = i2c;
+ struct gpio_desc *gpiod = gpio_to_desc(i2c_gpios[li2c->clock].gpio);
+
+ gpiod_set_value_cansleep(gpiod, value);
+}
+
+static int loongson_i2c_get_data(void *i2c)
+{
+ struct loongson_i2c *li2c = i2c;
+ struct gpio_desc *gpiod = gpio_to_desc(i2c_gpios[li2c->data].gpio);
+
+ return gpiod_get_value_cansleep(gpiod);
+}
+
+static int loongson_i2c_get_clock(void *i2c)
+{
+ struct loongson_i2c *li2c = i2c;
+ struct gpio_desc *gpiod = gpio_to_desc(i2c_gpios[li2c->clock].gpio);
+
+ return gpiod_get_value_cansleep(gpiod);
+}
+
+static int loongson_i2c_create(struct loongson_i2c *li2c, const char *name)
+{
+ int ret;
+ unsigned int i2c_num;
+ struct i2c_client *i2c_cli;
+ struct i2c_adapter *i2c_adapter;
+ struct i2c_board_info i2c_info;
+ struct i2c_algo_bit_data *i2c_algo_data;
+ struct device *dev;
+
+ dev = &li2c->adapter->dev;
+ i2c_num = li2c->i2c_id;
+ i2c_adapter = kzalloc(sizeof(struct i2c_adapter), GFP_KERNEL);
+ if (IS_ERR(i2c_adapter)) {
+ ret = PTR_ERR(i2c_adapter);
+ goto error_mem;
+ }
+ i2c_algo_data = kzalloc(sizeof(struct i2c_algo_bit_data), GFP_KERNEL);
+ if (IS_ERR(i2c_algo_data)) {
+ ret = PTR_ERR(i2c_algo_data);
+ goto error_mem;
+ }
+
+ i2c_adapter->owner = THIS_MODULE;
+ i2c_adapter->class = I2C_CLASS_DDC;
+ i2c_adapter->algo_data = i2c_algo_data;
+ i2c_adapter->nr = i2c_num;
+ snprintf(i2c_adapter->name, sizeof(i2c_adapter->name), "%s%d",
+ name, i2c_num - DC_I2C_BASE);
+
+ li2c->data = i2c_num % DC_I2C_BASE * 2;
+ li2c->clock = i2c_num % DC_I2C_BASE * 2 + 1;
+ DRM_INFO("Created i2c-%d, sda=%d, scl=%d\n",
+ i2c_num, li2c->data, li2c->clock);
+
+ if (gpio_cansleep(i2c_gpios[li2c->data].gpio) ||
+ gpio_cansleep(i2c_gpios[li2c->clock].gpio))
+ dev_warn(dev, "Slow GPIO pins might wreak havoc I2C timing\n");
+
+ i2c_algo_data->setsda = loongson_i2c_set_data;
+ i2c_algo_data->setscl = loongson_i2c_set_clock;
+ i2c_algo_data->getsda = loongson_i2c_get_data;
+ i2c_algo_data->getscl = loongson_i2c_get_clock;
+ i2c_algo_data->udelay = DC_I2C_TON;
+ i2c_algo_data->timeout = usecs_to_jiffies(2200);
+
+ ret = i2c_bit_add_numbered_bus(i2c_adapter);
+ if (ret) {
+ DRM_ERROR("Failed to register i2c algo-bit adapter %s\n",
+ i2c_adapter->name);
+ kfree(i2c_adapter);
+ i2c_adapter = NULL;
+ }
+
+ li2c->adapter = i2c_adapter;
+ i2c_algo_data->data = li2c;
+ i2c_set_adapdata(li2c->adapter, li2c);
+ DRM_INFO("Register i2c algo-bit adapter [%s]\n", i2c_adapter->name);
+
+ memset(&i2c_info, 0, sizeof(struct i2c_board_info));
+ strncpy(i2c_info.type, name, I2C_NAME_SIZE);
+ i2c_info.addr = DDC_ADDR;
+ i2c_cli = i2c_new_client_device(i2c_adapter, &i2c_info);
+ if (i2c_cli == NULL) {
+ DRM_ERROR("Failed to create i2c adapter\n");
+ return -EBUSY;
+ }
+ li2c->init = true;
+ return 0;
+
+error_mem:
+ DRM_ERROR("Failed to malloc memory for loongson i2c\n");
+ return ret;
+}
+
+static int loongson_i2c_add(struct loongson_device *ldev, const char *name)
+{
+ int i;
+
+ for (i = 0; i < LS_MAX_I2C_BUS; i++) {
+ if (ldev->i2c_bus[i].use)
+ loongson_i2c_create(&ldev->i2c_bus[i], name);
+ else {
+ DRM_DEBUG_DRIVER("i2c_bus[%d] not use\n", i);
+ return -ENODEV;
+ }
+ }
+ return 0;
+}
+
+int loongson_dc_gpio_init(struct loongson_device *ldev)
+{
+ int ret;
+ struct gpio_chip *chip;
+
+ chip = &ldev->chip;
+ chip->label = "ls7a-dc-gpio";
+ chip->base = LS7A_DC_GPIO_BASE;
+ chip->ngpio = 4;
+ chip->parent = ldev->dev->dev;
+ chip->request = ls_dc_gpio_request;
+ chip->direction_input = ls_dc_gpio_dir_input;
+ chip->direction_output = ls_dc_gpio_dir_output;
+ chip->set = ls_dc_gpio_set;
+ chip->get = ls_dc_gpio_get;
+ chip->can_sleep = false;
+
+ ret = devm_gpiochip_add_data(ldev->dev->dev, chip, ldev);
+ if (ret) {
+ DRM_ERROR("Failed to register ls7a dc gpio driver\n");
+ return -ENODEV;
+ }
+ DRM_INFO("Registered ls7a dc gpio driver\n");
+
+ return 0;
+}
+
+int loongson_i2c_init(struct loongson_device *ldev)
+{
+ int ret;
+
+ ret = gpio_request_array(i2c_gpios, ARRAY_SIZE(i2c_gpios));
+ if (ret) {
+ DRM_ERROR("Failed to request gpio array i2c_gpios\n");
+ return -ENODEV;
+ }
+
+ ldev->i2c_bus[0].i2c_id = 6;
+ ldev->i2c_bus[0].use = true;
+ ldev->i2c_bus[1].i2c_id = 7;
+ ldev->i2c_bus[1].use = true;
+
+ loongson_i2c_add(ldev, DC_I2C_NAME);
+
+ return 0;
+}
+
+struct loongson_i2c *loongson_i2c_bus_match(struct loongson_device *ldev, u32 i2c_id)
+{
+ u32 i;
+ struct loongson_i2c *match = NULL, *tables;
+
+ tables = ldev->i2c_bus;
+
+ for (i = 0; i < LS_MAX_I2C_BUS; i++) {
+ if (tables->i2c_id == i2c_id && tables->init == true) {
+ match = tables;
+ break;
+ }
+
+ tables++;
+ }
+
+ return match;
+}
+
diff --git a/drivers/gpu/drm/loongson/loongson_i2c.h b/drivers/gpu/drm/loongson/loongson_i2c.h
new file mode 100644
index 000000000000..50d4d3f4b10f
--- /dev/null
+++ b/drivers/gpu/drm/loongson/loongson_i2c.h
@@ -0,0 +1,38 @@
+/* SPDX-License-Identifier: GPL-2.0-only */
+
+#ifndef __LOONGSON_I2C_H__
+#define __LOONGSON_I2C_H__
+
+#include <linux/i2c.h>
+#include <linux/i2c-algo-bit.h>
+#include <linux/gpio/driver.h>
+#include <drm/drm_edid.h>
+
+#define DC_I2C_TON 5
+#define DC_I2C_BASE 6
+#define DC_I2C_NAME "ls_dc_i2c"
+#define LS_MAX_I2C_BUS 16
+
+/* Loongson 7A display controller proprietary GPIOs */
+#define LS7A_DC_GPIO_BASE 73
+#define DC_GPIO_0 (73)
+#define DC_GPIO_1 (74)
+#define DC_GPIO_2 (75)
+#define DC_GPIO_3 (76)
+#define LS7A_DC_GPIO_CFG_OFFSET (0x1660)
+#define LS7A_DC_GPIO_IN_OFFSET (0x1650)
+#define LS7A_DC_GPIO_OUT_OFFSET (0x1650)
+
+struct loongson_device;
+struct loongson_i2c {
+ struct i2c_adapter *adapter;
+ u32 data, clock;
+ bool use, init;
+ u32 i2c_id;
+};
+
+struct loongson_i2c *loongson_i2c_bus_match(struct loongson_device *ldev,
+ u32 i2c_id);
+int loongson_i2c_init(struct loongson_device *ldev);
+
+#endif /* __LOONGSON_I2C_H__ */
--
2.31.1
_______________________________________________
devel mailing list
devel@linuxdriverproject.org
http://driverdev.linuxdriverproject.org/mailman/listinfo/driverdev-devel
^ permalink raw reply related [flat|nested] 4+ messages in thread
* [PATCH 2/3] drm/loongson: Add GPIO and I2C driver for loongson drm.
2021-06-30 6:41 [PATCH 1/3] drm/loongson: Add DRM Driver for Loongson 7A1000 bridge chip lichenyang
@ 2021-06-30 6:41 ` lichenyang
0 siblings, 0 replies; 4+ messages in thread
From: lichenyang @ 2021-06-30 6:41 UTC (permalink / raw)
To: David Airlie, Daniel Vetter, linux-kernel, dri-devel
Cc: Tiezhu Yang, Huacai Chen
Implement use GPIO and I2C driver to detect connector
and fetch EDID via DDC.
Signed-off-by: lichenyang <lichenyang@loongson.cn>
---
drivers/gpu/drm/loongson/Makefile | 3 +-
drivers/gpu/drm/loongson/loongson_connector.c | 70 ++++-
drivers/gpu/drm/loongson/loongson_drv.c | 16 +-
drivers/gpu/drm/loongson/loongson_drv.h | 10 +
drivers/gpu/drm/loongson/loongson_i2c.c | 280 ++++++++++++++++++
drivers/gpu/drm/loongson/loongson_i2c.h | 38 +++
6 files changed, 410 insertions(+), 7 deletions(-)
create mode 100644 drivers/gpu/drm/loongson/loongson_i2c.c
create mode 100644 drivers/gpu/drm/loongson/loongson_i2c.h
diff --git a/drivers/gpu/drm/loongson/Makefile b/drivers/gpu/drm/loongson/Makefile
index 22d063953b78..773b806e99a2 100644
--- a/drivers/gpu/drm/loongson/Makefile
+++ b/drivers/gpu/drm/loongson/Makefile
@@ -10,5 +10,6 @@ loongson-y := loongson_drv.o \
loongson_plane.o \
loongson_device.o \
loongson_connector.o \
- loongson_encoder.o
+ loongson_encoder.o \
+ loongson_i2c.o
obj-$(CONFIG_DRM_LOONGSON) += loongson.o
diff --git a/drivers/gpu/drm/loongson/loongson_connector.c b/drivers/gpu/drm/loongson/loongson_connector.c
index 6b1f0ffa33bd..2096a6ddc366 100644
--- a/drivers/gpu/drm/loongson/loongson_connector.c
+++ b/drivers/gpu/drm/loongson/loongson_connector.c
@@ -4,12 +4,65 @@
static int loongson_get_modes(struct drm_connector *connector)
{
- int count;
+ struct loongson_connector *lconnector;
+ struct i2c_adapter *adapter;
+ struct edid *edid = NULL;
+ u32 ret;
+
+ lconnector = to_loongson_connector(connector);
+ adapter = lconnector->i2c->adapter;
- count = drm_add_modes_noedid(connector, 1920, 1080);
- drm_set_preferred_mode(connector, 1024, 768);
+ if (adapter != NULL)
+ edid = drm_get_edid(connector, adapter);
+ else
+ DRM_DEBUG_KMS("get loongson connector adapter err\n");
- return count;
+ if (edid) {
+ drm_connector_update_edid_property(connector, edid);
+ ret = drm_add_edid_modes(connector, edid);
+ } else {
+ DRM_ERROR("Failed to read EDID\n");
+ ret = drm_add_modes_noedid(connector, 1024, 768);
+ }
+
+ return ret;
+}
+
+static bool is_connected(struct loongson_connector *ls_connector)
+{
+ unsigned char start = 0x0;
+ struct i2c_adapter *adapter;
+ struct i2c_msg msgs = {
+ .addr = DDC_ADDR,
+ .flags = 0,
+ .len = 1,
+ .buf = &start,
+ };
+
+ if (!ls_connector->i2c)
+ return false;
+
+ adapter = ls_connector->i2c->adapter;
+ if (i2c_transfer(adapter, &msgs, 1) != 1) {
+ DRM_DEBUG_KMS("display-%d not connect\n", ls_connector->id);
+ return false;
+ }
+
+ return true;
+}
+
+static enum drm_connector_status
+loongson_detect(struct drm_connector *connector, bool force)
+{
+ struct loongson_connector *lconnector;
+ enum drm_connector_status ret = connector_status_disconnected;
+
+ lconnector = to_loongson_connector(connector);
+
+ if (is_connected(lconnector))
+ ret = connector_status_connected;
+
+ return ret;
}
static const struct drm_connector_helper_funcs loongson_connector_helper = {
@@ -17,6 +70,7 @@ static const struct drm_connector_helper_funcs loongson_connector_helper = {
};
static const struct drm_connector_funcs loongson_connector_funcs = {
+ .detect = loongson_detect,
.fill_modes = drm_helper_probe_single_connector_modes,
.destroy = drm_connector_cleanup,
.reset = drm_atomic_helper_connector_reset,
@@ -37,11 +91,17 @@ int loongson_connector_init(struct loongson_device *ldev, int index)
lconnector->ldev = ldev;
lconnector->id = index;
+ lconnector->i2c_id = index + DC_I2C_BASE;
+
+ lconnector->i2c = loongson_i2c_bus_match(ldev, lconnector->i2c_id);
+ if (!lconnector->i2c)
+ DRM_INFO("connector-%d match i2c-%d err\n", index,
+ lconnector->i2c_id);
ldev->mode_info[index].connector = lconnector;
connector = &lconnector->base;
drm_connector_init(ldev->dev, connector, &loongson_connector_funcs,
- DRM_MODE_CONNECTOR_Unknown);
+ DRM_MODE_CONNECTOR_Unknown);
drm_connector_helper_add(connector, &loongson_connector_helper);
return 0;
diff --git a/drivers/gpu/drm/loongson/loongson_drv.c b/drivers/gpu/drm/loongson/loongson_drv.c
index e405199a3df6..252be9e25aff 100644
--- a/drivers/gpu/drm/loongson/loongson_drv.c
+++ b/drivers/gpu/drm/loongson/loongson_drv.c
@@ -11,9 +11,10 @@
/* Interface history:
* 0.1 - original.
+ * 0.2 - add i2c and connector detect.
*/
#define DRIVER_MAJOR 0
-#define DRIVER_MINOR 1
+#define DRIVER_MINOR 2
static const struct drm_mode_config_funcs loongson_mode_funcs = {
.fb_create = drm_gem_fb_create,
@@ -31,6 +32,7 @@ static int loongson_device_init(struct drm_device *dev, uint32_t flags)
resource_size_t aper_size;
resource_size_t mmio_base;
resource_size_t mmio_size;
+ u32 ret;
/* GPU MEM */
/* We need get 7A-gpu pci device information for ldev->gpu_pdev */
@@ -72,6 +74,18 @@ static int loongson_device_init(struct drm_device *dev, uint32_t flags)
if (ldev->io == NULL)
return -ENOMEM;
+ ret = loongson_dc_gpio_init(ldev);
+ if (ret) {
+ DRM_ERROR("Failed to initialize dc gpios\n");
+ return ret;
+ }
+
+ ret = loongson_i2c_init(ldev);
+ if (ret) {
+ DRM_ERROR("Failed to initialize dc i2c\n");
+ return ret;
+ }
+
DRM_INFO("DC mmio base 0x%llx size 0x%llx io 0x%llx\n",
mmio_base, mmio_size, *(u64 *)ldev->io);
DRM_INFO("GPU vram start = 0x%x size = 0x%x\n",
diff --git a/drivers/gpu/drm/loongson/loongson_drv.h b/drivers/gpu/drm/loongson/loongson_drv.h
index 498d1b082a19..24a534c3c79c 100644
--- a/drivers/gpu/drm/loongson/loongson_drv.h
+++ b/drivers/gpu/drm/loongson/loongson_drv.h
@@ -18,6 +18,7 @@
#include <drm/drm_crtc_helper.h>
#include <drm/drm_connector.h>
#include <drm/drm_encoder.h>
+#include "loongson_i2c.h"
/* General customization:
*/
@@ -28,6 +29,7 @@
#define to_loongson_crtc(x) container_of(x, struct loongson_crtc, base)
#define to_loongson_encoder(x) container_of(x, struct loongson_encoder, base)
+#define to_loongson_connector(x) container_of(x, struct loongson_connector, base)
#define LS7A_CHIPCFG_REG_BASE (0x10010000)
#define PCI_DEVICE_ID_LOONGSON_DC 0x7a06
@@ -92,8 +94,10 @@ struct loongson_encoder {
struct loongson_connector {
struct drm_connector base;
struct loongson_device *ldev;
+ struct loongson_i2c *i2c;
u16 id;
u32 type;
+ u16 i2c_id;
};
struct loongson_mode_info {
@@ -115,6 +119,9 @@ struct loongson_device {
u32 num_crtc;
struct loongson_mode_info mode_info[2];
struct pci_dev *gpu_pdev; /* LS7A gpu device info */
+
+ struct loongson_i2c i2c_bus[LS_MAX_I2C_BUS];
+ struct gpio_chip chip;
};
/* crtc */
@@ -129,6 +136,9 @@ int loongson_encoder_init(struct loongson_device *ldev, int index);
/* plane */
int loongson_plane_init(struct loongson_crtc *lcrtc);
+/* i2c */
+int loongson_dc_gpio_init(struct loongson_device *ldev);
+
/* device */
u32 loongson_gpu_offset(struct drm_plane_state *state);
u32 ls7a_mm_rreg(struct loongson_device *ldev, u32 offset);
diff --git a/drivers/gpu/drm/loongson/loongson_i2c.c b/drivers/gpu/drm/loongson/loongson_i2c.c
new file mode 100644
index 000000000000..ef06a6787e34
--- /dev/null
+++ b/drivers/gpu/drm/loongson/loongson_i2c.c
@@ -0,0 +1,280 @@
+// SPDX-License-Identifier: GPL-2.0-or-later
+
+#include "loongson_i2c.h"
+#include "loongson_drv.h"
+#include "linux/gpio.h"
+#include <linux/gpio/consumer.h>
+
+static struct gpio i2c_gpios[4] = {
+ { .gpio = DC_GPIO_0, .flags = GPIOF_OPEN_DRAIN, .label = "i2c-6-sda" },
+ { .gpio = DC_GPIO_1, .flags = GPIOF_OPEN_DRAIN, .label = "i2c-6-scl" },
+ { .gpio = DC_GPIO_2, .flags = GPIOF_OPEN_DRAIN, .label = "i2c-7-sda" },
+ { .gpio = DC_GPIO_3, .flags = GPIOF_OPEN_DRAIN, .label = "i2c-7-scl" },
+};
+
+static inline void __dc_gpio_set_dir(struct loongson_device *ldev,
+ unsigned int pin, int input)
+{
+ u32 temp;
+
+ temp = ls7a_mm_rreg(ldev, LS7A_DC_GPIO_CFG_OFFSET);
+
+ if (input)
+ temp |= 1UL << pin;
+ else
+ temp &= ~(1UL << pin);
+
+ ls7a_mm_wreg(ldev, LS7A_DC_GPIO_CFG_OFFSET, temp);
+}
+
+static void __dc_gpio_set_val(struct loongson_device *ldev,
+ unsigned int pin, int high)
+{
+ u32 temp;
+
+ temp = ls7a_mm_rreg(ldev, LS7A_DC_GPIO_OUT_OFFSET);
+
+ if (high)
+ temp |= 1UL << pin;
+ else
+ temp &= ~(1UL << pin);
+
+ ls7a_mm_wreg(ldev, LS7A_DC_GPIO_OUT_OFFSET, temp);
+}
+
+static int ls_dc_gpio_request(struct gpio_chip *chip, unsigned int pin)
+{
+ if (pin >= (chip->ngpio + chip->base))
+ return -EINVAL;
+ else
+ return 0;
+}
+
+static int ls_dc_gpio_dir_input(struct gpio_chip *chip, unsigned int pin)
+{
+ struct loongson_device *ldev;
+
+ ldev = container_of(chip, struct loongson_device, chip);
+ __dc_gpio_set_dir(ldev, pin, 1);
+
+ return 0;
+}
+
+static int ls_dc_gpio_dir_output(struct gpio_chip *chip,
+ unsigned int pin, int value)
+{
+ struct loongson_device *ldev;
+
+ ldev = container_of(chip, struct loongson_device, chip);
+ __dc_gpio_set_val(ldev, pin, value);
+ __dc_gpio_set_dir(ldev, pin, 0);
+
+ return 0;
+}
+
+static void ls_dc_gpio_set(struct gpio_chip *chip, unsigned int pin, int value)
+{
+ struct loongson_device *ldev;
+
+ ldev = container_of(chip, struct loongson_device, chip);
+ __dc_gpio_set_val(ldev, pin, value);
+}
+
+static int ls_dc_gpio_get(struct gpio_chip *chip, unsigned int pin)
+{
+ u32 val;
+ struct loongson_device *ldev;
+
+ ldev = container_of(chip, struct loongson_device, chip);
+ val = ls7a_mm_rreg(ldev, LS7A_DC_GPIO_IN_OFFSET);
+ return (val >> pin) & 1;
+}
+
+static void loongson_i2c_set_data(void *i2c, int value)
+{
+ struct loongson_i2c *li2c = i2c;
+ struct gpio_desc *gpiod = gpio_to_desc(i2c_gpios[li2c->data].gpio);
+
+ gpiod_set_value_cansleep(gpiod, value);
+}
+
+static void loongson_i2c_set_clock(void *i2c, int value)
+{
+ struct loongson_i2c *li2c = i2c;
+ struct gpio_desc *gpiod = gpio_to_desc(i2c_gpios[li2c->clock].gpio);
+
+ gpiod_set_value_cansleep(gpiod, value);
+}
+
+static int loongson_i2c_get_data(void *i2c)
+{
+ struct loongson_i2c *li2c = i2c;
+ struct gpio_desc *gpiod = gpio_to_desc(i2c_gpios[li2c->data].gpio);
+
+ return gpiod_get_value_cansleep(gpiod);
+}
+
+static int loongson_i2c_get_clock(void *i2c)
+{
+ struct loongson_i2c *li2c = i2c;
+ struct gpio_desc *gpiod = gpio_to_desc(i2c_gpios[li2c->clock].gpio);
+
+ return gpiod_get_value_cansleep(gpiod);
+}
+
+static int loongson_i2c_create(struct loongson_i2c *li2c, const char *name)
+{
+ int ret;
+ unsigned int i2c_num;
+ struct i2c_client *i2c_cli;
+ struct i2c_adapter *i2c_adapter;
+ struct i2c_board_info i2c_info;
+ struct i2c_algo_bit_data *i2c_algo_data;
+ struct device *dev;
+
+ dev = &li2c->adapter->dev;
+ i2c_num = li2c->i2c_id;
+ i2c_adapter = kzalloc(sizeof(struct i2c_adapter), GFP_KERNEL);
+ if (IS_ERR(i2c_adapter)) {
+ ret = PTR_ERR(i2c_adapter);
+ goto error_mem;
+ }
+ i2c_algo_data = kzalloc(sizeof(struct i2c_algo_bit_data), GFP_KERNEL);
+ if (IS_ERR(i2c_algo_data)) {
+ ret = PTR_ERR(i2c_algo_data);
+ goto error_mem;
+ }
+
+ i2c_adapter->owner = THIS_MODULE;
+ i2c_adapter->class = I2C_CLASS_DDC;
+ i2c_adapter->algo_data = i2c_algo_data;
+ i2c_adapter->nr = i2c_num;
+ snprintf(i2c_adapter->name, sizeof(i2c_adapter->name), "%s%d",
+ name, i2c_num - DC_I2C_BASE);
+
+ li2c->data = i2c_num % DC_I2C_BASE * 2;
+ li2c->clock = i2c_num % DC_I2C_BASE * 2 + 1;
+ DRM_INFO("Created i2c-%d, sda=%d, scl=%d\n",
+ i2c_num, li2c->data, li2c->clock);
+
+ if (gpio_cansleep(i2c_gpios[li2c->data].gpio) ||
+ gpio_cansleep(i2c_gpios[li2c->clock].gpio))
+ dev_warn(dev, "Slow GPIO pins might wreak havoc I2C timing\n");
+
+ i2c_algo_data->setsda = loongson_i2c_set_data;
+ i2c_algo_data->setscl = loongson_i2c_set_clock;
+ i2c_algo_data->getsda = loongson_i2c_get_data;
+ i2c_algo_data->getscl = loongson_i2c_get_clock;
+ i2c_algo_data->udelay = DC_I2C_TON;
+ i2c_algo_data->timeout = usecs_to_jiffies(2200);
+
+ ret = i2c_bit_add_numbered_bus(i2c_adapter);
+ if (ret) {
+ DRM_ERROR("Failed to register i2c algo-bit adapter %s\n",
+ i2c_adapter->name);
+ kfree(i2c_adapter);
+ i2c_adapter = NULL;
+ }
+
+ li2c->adapter = i2c_adapter;
+ i2c_algo_data->data = li2c;
+ i2c_set_adapdata(li2c->adapter, li2c);
+ DRM_INFO("Register i2c algo-bit adapter [%s]\n", i2c_adapter->name);
+
+ memset(&i2c_info, 0, sizeof(struct i2c_board_info));
+ strncpy(i2c_info.type, name, I2C_NAME_SIZE);
+ i2c_info.addr = DDC_ADDR;
+ i2c_cli = i2c_new_client_device(i2c_adapter, &i2c_info);
+ if (i2c_cli == NULL) {
+ DRM_ERROR("Failed to create i2c adapter\n");
+ return -EBUSY;
+ }
+ li2c->init = true;
+ return 0;
+
+error_mem:
+ DRM_ERROR("Failed to malloc memory for loongson i2c\n");
+ return ret;
+}
+
+static int loongson_i2c_add(struct loongson_device *ldev, const char *name)
+{
+ int i;
+
+ for (i = 0; i < LS_MAX_I2C_BUS; i++) {
+ if (ldev->i2c_bus[i].use)
+ loongson_i2c_create(&ldev->i2c_bus[i], name);
+ else {
+ DRM_DEBUG_DRIVER("i2c_bus[%d] not use\n", i);
+ return -ENODEV;
+ }
+ }
+ return 0;
+}
+
+int loongson_dc_gpio_init(struct loongson_device *ldev)
+{
+ int ret;
+ struct gpio_chip *chip;
+
+ chip = &ldev->chip;
+ chip->label = "ls7a-dc-gpio";
+ chip->base = LS7A_DC_GPIO_BASE;
+ chip->ngpio = 4;
+ chip->parent = ldev->dev->dev;
+ chip->request = ls_dc_gpio_request;
+ chip->direction_input = ls_dc_gpio_dir_input;
+ chip->direction_output = ls_dc_gpio_dir_output;
+ chip->set = ls_dc_gpio_set;
+ chip->get = ls_dc_gpio_get;
+ chip->can_sleep = false;
+
+ ret = devm_gpiochip_add_data(ldev->dev->dev, chip, ldev);
+ if (ret) {
+ DRM_ERROR("Failed to register ls7a dc gpio driver\n");
+ return -ENODEV;
+ }
+ DRM_INFO("Registered ls7a dc gpio driver\n");
+
+ return 0;
+}
+
+int loongson_i2c_init(struct loongson_device *ldev)
+{
+ int ret;
+
+ ret = gpio_request_array(i2c_gpios, ARRAY_SIZE(i2c_gpios));
+ if (ret) {
+ DRM_ERROR("Failed to request gpio array i2c_gpios\n");
+ return -ENODEV;
+ }
+
+ ldev->i2c_bus[0].i2c_id = 6;
+ ldev->i2c_bus[0].use = true;
+ ldev->i2c_bus[1].i2c_id = 7;
+ ldev->i2c_bus[1].use = true;
+
+ loongson_i2c_add(ldev, DC_I2C_NAME);
+
+ return 0;
+}
+
+struct loongson_i2c *loongson_i2c_bus_match(struct loongson_device *ldev, u32 i2c_id)
+{
+ u32 i;
+ struct loongson_i2c *match = NULL, *tables;
+
+ tables = ldev->i2c_bus;
+
+ for (i = 0; i < LS_MAX_I2C_BUS; i++) {
+ if (tables->i2c_id == i2c_id && tables->init == true) {
+ match = tables;
+ break;
+ }
+
+ tables++;
+ }
+
+ return match;
+}
+
diff --git a/drivers/gpu/drm/loongson/loongson_i2c.h b/drivers/gpu/drm/loongson/loongson_i2c.h
new file mode 100644
index 000000000000..50d4d3f4b10f
--- /dev/null
+++ b/drivers/gpu/drm/loongson/loongson_i2c.h
@@ -0,0 +1,38 @@
+/* SPDX-License-Identifier: GPL-2.0-only */
+
+#ifndef __LOONGSON_I2C_H__
+#define __LOONGSON_I2C_H__
+
+#include <linux/i2c.h>
+#include <linux/i2c-algo-bit.h>
+#include <linux/gpio/driver.h>
+#include <drm/drm_edid.h>
+
+#define DC_I2C_TON 5
+#define DC_I2C_BASE 6
+#define DC_I2C_NAME "ls_dc_i2c"
+#define LS_MAX_I2C_BUS 16
+
+/* Loongson 7A display controller proprietary GPIOs */
+#define LS7A_DC_GPIO_BASE 73
+#define DC_GPIO_0 (73)
+#define DC_GPIO_1 (74)
+#define DC_GPIO_2 (75)
+#define DC_GPIO_3 (76)
+#define LS7A_DC_GPIO_CFG_OFFSET (0x1660)
+#define LS7A_DC_GPIO_IN_OFFSET (0x1650)
+#define LS7A_DC_GPIO_OUT_OFFSET (0x1650)
+
+struct loongson_device;
+struct loongson_i2c {
+ struct i2c_adapter *adapter;
+ u32 data, clock;
+ bool use, init;
+ u32 i2c_id;
+};
+
+struct loongson_i2c *loongson_i2c_bus_match(struct loongson_device *ldev,
+ u32 i2c_id);
+int loongson_i2c_init(struct loongson_device *ldev);
+
+#endif /* __LOONGSON_I2C_H__ */
--
2.31.1
^ permalink raw reply related [flat|nested] 4+ messages in thread
* [PATCH 2/3] drm/loongson: Add GPIO and I2C driver for loongson drm.
2021-06-04 7:59 [PATCH 1/3] drm/loongson: Add DRM Driver for Loongson 7A1000 bridge chip lichenyang
@ 2021-06-04 7:59 ` lichenyang
0 siblings, 0 replies; 4+ messages in thread
From: lichenyang @ 2021-06-04 7:59 UTC (permalink / raw)
To: David Airlie, Daniel Vetter, linux-kernel, dri-devel, Huacai Chen
Cc: Tiezhu Yang
Implement use GPIO and I2C driver to detect connector
and fetch EDID via DDC.
Signed-off-by: lichenyang <lichenyang@loongson.cn>
---
drivers/gpu/drm/loongson/Makefile | 3 +-
drivers/gpu/drm/loongson/loongson_connector.c | 70 ++++-
drivers/gpu/drm/loongson/loongson_drv.c | 16 +-
drivers/gpu/drm/loongson/loongson_drv.h | 10 +
drivers/gpu/drm/loongson/loongson_i2c.c | 280 ++++++++++++++++++
drivers/gpu/drm/loongson/loongson_i2c.h | 38 +++
6 files changed, 410 insertions(+), 7 deletions(-)
create mode 100644 drivers/gpu/drm/loongson/loongson_i2c.c
create mode 100644 drivers/gpu/drm/loongson/loongson_i2c.h
diff --git a/drivers/gpu/drm/loongson/Makefile b/drivers/gpu/drm/loongson/Makefile
index 22d063953b78..773b806e99a2 100644
--- a/drivers/gpu/drm/loongson/Makefile
+++ b/drivers/gpu/drm/loongson/Makefile
@@ -10,5 +10,6 @@ loongson-y := loongson_drv.o \
loongson_plane.o \
loongson_device.o \
loongson_connector.o \
- loongson_encoder.o
+ loongson_encoder.o \
+ loongson_i2c.o
obj-$(CONFIG_DRM_LOONGSON) += loongson.o
diff --git a/drivers/gpu/drm/loongson/loongson_connector.c b/drivers/gpu/drm/loongson/loongson_connector.c
index 6b1f0ffa33bd..2096a6ddc366 100644
--- a/drivers/gpu/drm/loongson/loongson_connector.c
+++ b/drivers/gpu/drm/loongson/loongson_connector.c
@@ -4,12 +4,65 @@
static int loongson_get_modes(struct drm_connector *connector)
{
- int count;
+ struct loongson_connector *lconnector;
+ struct i2c_adapter *adapter;
+ struct edid *edid = NULL;
+ u32 ret;
+
+ lconnector = to_loongson_connector(connector);
+ adapter = lconnector->i2c->adapter;
- count = drm_add_modes_noedid(connector, 1920, 1080);
- drm_set_preferred_mode(connector, 1024, 768);
+ if (adapter != NULL)
+ edid = drm_get_edid(connector, adapter);
+ else
+ DRM_DEBUG_KMS("get loongson connector adapter err\n");
- return count;
+ if (edid) {
+ drm_connector_update_edid_property(connector, edid);
+ ret = drm_add_edid_modes(connector, edid);
+ } else {
+ DRM_ERROR("Failed to read EDID\n");
+ ret = drm_add_modes_noedid(connector, 1024, 768);
+ }
+
+ return ret;
+}
+
+static bool is_connected(struct loongson_connector *ls_connector)
+{
+ unsigned char start = 0x0;
+ struct i2c_adapter *adapter;
+ struct i2c_msg msgs = {
+ .addr = DDC_ADDR,
+ .flags = 0,
+ .len = 1,
+ .buf = &start,
+ };
+
+ if (!ls_connector->i2c)
+ return false;
+
+ adapter = ls_connector->i2c->adapter;
+ if (i2c_transfer(adapter, &msgs, 1) != 1) {
+ DRM_DEBUG_KMS("display-%d not connect\n", ls_connector->id);
+ return false;
+ }
+
+ return true;
+}
+
+static enum drm_connector_status
+loongson_detect(struct drm_connector *connector, bool force)
+{
+ struct loongson_connector *lconnector;
+ enum drm_connector_status ret = connector_status_disconnected;
+
+ lconnector = to_loongson_connector(connector);
+
+ if (is_connected(lconnector))
+ ret = connector_status_connected;
+
+ return ret;
}
static const struct drm_connector_helper_funcs loongson_connector_helper = {
@@ -17,6 +70,7 @@ static const struct drm_connector_helper_funcs loongson_connector_helper = {
};
static const struct drm_connector_funcs loongson_connector_funcs = {
+ .detect = loongson_detect,
.fill_modes = drm_helper_probe_single_connector_modes,
.destroy = drm_connector_cleanup,
.reset = drm_atomic_helper_connector_reset,
@@ -37,11 +91,17 @@ int loongson_connector_init(struct loongson_device *ldev, int index)
lconnector->ldev = ldev;
lconnector->id = index;
+ lconnector->i2c_id = index + DC_I2C_BASE;
+
+ lconnector->i2c = loongson_i2c_bus_match(ldev, lconnector->i2c_id);
+ if (!lconnector->i2c)
+ DRM_INFO("connector-%d match i2c-%d err\n", index,
+ lconnector->i2c_id);
ldev->mode_info[index].connector = lconnector;
connector = &lconnector->base;
drm_connector_init(ldev->dev, connector, &loongson_connector_funcs,
- DRM_MODE_CONNECTOR_Unknown);
+ DRM_MODE_CONNECTOR_Unknown);
drm_connector_helper_add(connector, &loongson_connector_helper);
return 0;
diff --git a/drivers/gpu/drm/loongson/loongson_drv.c b/drivers/gpu/drm/loongson/loongson_drv.c
index e405199a3df6..252be9e25aff 100644
--- a/drivers/gpu/drm/loongson/loongson_drv.c
+++ b/drivers/gpu/drm/loongson/loongson_drv.c
@@ -11,9 +11,10 @@
/* Interface history:
* 0.1 - original.
+ * 0.2 - add i2c and connector detect.
*/
#define DRIVER_MAJOR 0
-#define DRIVER_MINOR 1
+#define DRIVER_MINOR 2
static const struct drm_mode_config_funcs loongson_mode_funcs = {
.fb_create = drm_gem_fb_create,
@@ -31,6 +32,7 @@ static int loongson_device_init(struct drm_device *dev, uint32_t flags)
resource_size_t aper_size;
resource_size_t mmio_base;
resource_size_t mmio_size;
+ u32 ret;
/* GPU MEM */
/* We need get 7A-gpu pci device information for ldev->gpu_pdev */
@@ -72,6 +74,18 @@ static int loongson_device_init(struct drm_device *dev, uint32_t flags)
if (ldev->io == NULL)
return -ENOMEM;
+ ret = loongson_dc_gpio_init(ldev);
+ if (ret) {
+ DRM_ERROR("Failed to initialize dc gpios\n");
+ return ret;
+ }
+
+ ret = loongson_i2c_init(ldev);
+ if (ret) {
+ DRM_ERROR("Failed to initialize dc i2c\n");
+ return ret;
+ }
+
DRM_INFO("DC mmio base 0x%llx size 0x%llx io 0x%llx\n",
mmio_base, mmio_size, *(u64 *)ldev->io);
DRM_INFO("GPU vram start = 0x%x size = 0x%x\n",
diff --git a/drivers/gpu/drm/loongson/loongson_drv.h b/drivers/gpu/drm/loongson/loongson_drv.h
index 498d1b082a19..24a534c3c79c 100644
--- a/drivers/gpu/drm/loongson/loongson_drv.h
+++ b/drivers/gpu/drm/loongson/loongson_drv.h
@@ -18,6 +18,7 @@
#include <drm/drm_crtc_helper.h>
#include <drm/drm_connector.h>
#include <drm/drm_encoder.h>
+#include "loongson_i2c.h"
/* General customization:
*/
@@ -28,6 +29,7 @@
#define to_loongson_crtc(x) container_of(x, struct loongson_crtc, base)
#define to_loongson_encoder(x) container_of(x, struct loongson_encoder, base)
+#define to_loongson_connector(x) container_of(x, struct loongson_connector, base)
#define LS7A_CHIPCFG_REG_BASE (0x10010000)
#define PCI_DEVICE_ID_LOONGSON_DC 0x7a06
@@ -92,8 +94,10 @@ struct loongson_encoder {
struct loongson_connector {
struct drm_connector base;
struct loongson_device *ldev;
+ struct loongson_i2c *i2c;
u16 id;
u32 type;
+ u16 i2c_id;
};
struct loongson_mode_info {
@@ -115,6 +119,9 @@ struct loongson_device {
u32 num_crtc;
struct loongson_mode_info mode_info[2];
struct pci_dev *gpu_pdev; /* LS7A gpu device info */
+
+ struct loongson_i2c i2c_bus[LS_MAX_I2C_BUS];
+ struct gpio_chip chip;
};
/* crtc */
@@ -129,6 +136,9 @@ int loongson_encoder_init(struct loongson_device *ldev, int index);
/* plane */
int loongson_plane_init(struct loongson_crtc *lcrtc);
+/* i2c */
+int loongson_dc_gpio_init(struct loongson_device *ldev);
+
/* device */
u32 loongson_gpu_offset(struct drm_plane_state *state);
u32 ls7a_mm_rreg(struct loongson_device *ldev, u32 offset);
diff --git a/drivers/gpu/drm/loongson/loongson_i2c.c b/drivers/gpu/drm/loongson/loongson_i2c.c
new file mode 100644
index 000000000000..ef06a6787e34
--- /dev/null
+++ b/drivers/gpu/drm/loongson/loongson_i2c.c
@@ -0,0 +1,280 @@
+// SPDX-License-Identifier: GPL-2.0-or-later
+
+#include "loongson_i2c.h"
+#include "loongson_drv.h"
+#include "linux/gpio.h"
+#include <linux/gpio/consumer.h>
+
+static struct gpio i2c_gpios[4] = {
+ { .gpio = DC_GPIO_0, .flags = GPIOF_OPEN_DRAIN, .label = "i2c-6-sda" },
+ { .gpio = DC_GPIO_1, .flags = GPIOF_OPEN_DRAIN, .label = "i2c-6-scl" },
+ { .gpio = DC_GPIO_2, .flags = GPIOF_OPEN_DRAIN, .label = "i2c-7-sda" },
+ { .gpio = DC_GPIO_3, .flags = GPIOF_OPEN_DRAIN, .label = "i2c-7-scl" },
+};
+
+static inline void __dc_gpio_set_dir(struct loongson_device *ldev,
+ unsigned int pin, int input)
+{
+ u32 temp;
+
+ temp = ls7a_mm_rreg(ldev, LS7A_DC_GPIO_CFG_OFFSET);
+
+ if (input)
+ temp |= 1UL << pin;
+ else
+ temp &= ~(1UL << pin);
+
+ ls7a_mm_wreg(ldev, LS7A_DC_GPIO_CFG_OFFSET, temp);
+}
+
+static void __dc_gpio_set_val(struct loongson_device *ldev,
+ unsigned int pin, int high)
+{
+ u32 temp;
+
+ temp = ls7a_mm_rreg(ldev, LS7A_DC_GPIO_OUT_OFFSET);
+
+ if (high)
+ temp |= 1UL << pin;
+ else
+ temp &= ~(1UL << pin);
+
+ ls7a_mm_wreg(ldev, LS7A_DC_GPIO_OUT_OFFSET, temp);
+}
+
+static int ls_dc_gpio_request(struct gpio_chip *chip, unsigned int pin)
+{
+ if (pin >= (chip->ngpio + chip->base))
+ return -EINVAL;
+ else
+ return 0;
+}
+
+static int ls_dc_gpio_dir_input(struct gpio_chip *chip, unsigned int pin)
+{
+ struct loongson_device *ldev;
+
+ ldev = container_of(chip, struct loongson_device, chip);
+ __dc_gpio_set_dir(ldev, pin, 1);
+
+ return 0;
+}
+
+static int ls_dc_gpio_dir_output(struct gpio_chip *chip,
+ unsigned int pin, int value)
+{
+ struct loongson_device *ldev;
+
+ ldev = container_of(chip, struct loongson_device, chip);
+ __dc_gpio_set_val(ldev, pin, value);
+ __dc_gpio_set_dir(ldev, pin, 0);
+
+ return 0;
+}
+
+static void ls_dc_gpio_set(struct gpio_chip *chip, unsigned int pin, int value)
+{
+ struct loongson_device *ldev;
+
+ ldev = container_of(chip, struct loongson_device, chip);
+ __dc_gpio_set_val(ldev, pin, value);
+}
+
+static int ls_dc_gpio_get(struct gpio_chip *chip, unsigned int pin)
+{
+ u32 val;
+ struct loongson_device *ldev;
+
+ ldev = container_of(chip, struct loongson_device, chip);
+ val = ls7a_mm_rreg(ldev, LS7A_DC_GPIO_IN_OFFSET);
+ return (val >> pin) & 1;
+}
+
+static void loongson_i2c_set_data(void *i2c, int value)
+{
+ struct loongson_i2c *li2c = i2c;
+ struct gpio_desc *gpiod = gpio_to_desc(i2c_gpios[li2c->data].gpio);
+
+ gpiod_set_value_cansleep(gpiod, value);
+}
+
+static void loongson_i2c_set_clock(void *i2c, int value)
+{
+ struct loongson_i2c *li2c = i2c;
+ struct gpio_desc *gpiod = gpio_to_desc(i2c_gpios[li2c->clock].gpio);
+
+ gpiod_set_value_cansleep(gpiod, value);
+}
+
+static int loongson_i2c_get_data(void *i2c)
+{
+ struct loongson_i2c *li2c = i2c;
+ struct gpio_desc *gpiod = gpio_to_desc(i2c_gpios[li2c->data].gpio);
+
+ return gpiod_get_value_cansleep(gpiod);
+}
+
+static int loongson_i2c_get_clock(void *i2c)
+{
+ struct loongson_i2c *li2c = i2c;
+ struct gpio_desc *gpiod = gpio_to_desc(i2c_gpios[li2c->clock].gpio);
+
+ return gpiod_get_value_cansleep(gpiod);
+}
+
+static int loongson_i2c_create(struct loongson_i2c *li2c, const char *name)
+{
+ int ret;
+ unsigned int i2c_num;
+ struct i2c_client *i2c_cli;
+ struct i2c_adapter *i2c_adapter;
+ struct i2c_board_info i2c_info;
+ struct i2c_algo_bit_data *i2c_algo_data;
+ struct device *dev;
+
+ dev = &li2c->adapter->dev;
+ i2c_num = li2c->i2c_id;
+ i2c_adapter = kzalloc(sizeof(struct i2c_adapter), GFP_KERNEL);
+ if (IS_ERR(i2c_adapter)) {
+ ret = PTR_ERR(i2c_adapter);
+ goto error_mem;
+ }
+ i2c_algo_data = kzalloc(sizeof(struct i2c_algo_bit_data), GFP_KERNEL);
+ if (IS_ERR(i2c_algo_data)) {
+ ret = PTR_ERR(i2c_algo_data);
+ goto error_mem;
+ }
+
+ i2c_adapter->owner = THIS_MODULE;
+ i2c_adapter->class = I2C_CLASS_DDC;
+ i2c_adapter->algo_data = i2c_algo_data;
+ i2c_adapter->nr = i2c_num;
+ snprintf(i2c_adapter->name, sizeof(i2c_adapter->name), "%s%d",
+ name, i2c_num - DC_I2C_BASE);
+
+ li2c->data = i2c_num % DC_I2C_BASE * 2;
+ li2c->clock = i2c_num % DC_I2C_BASE * 2 + 1;
+ DRM_INFO("Created i2c-%d, sda=%d, scl=%d\n",
+ i2c_num, li2c->data, li2c->clock);
+
+ if (gpio_cansleep(i2c_gpios[li2c->data].gpio) ||
+ gpio_cansleep(i2c_gpios[li2c->clock].gpio))
+ dev_warn(dev, "Slow GPIO pins might wreak havoc I2C timing\n");
+
+ i2c_algo_data->setsda = loongson_i2c_set_data;
+ i2c_algo_data->setscl = loongson_i2c_set_clock;
+ i2c_algo_data->getsda = loongson_i2c_get_data;
+ i2c_algo_data->getscl = loongson_i2c_get_clock;
+ i2c_algo_data->udelay = DC_I2C_TON;
+ i2c_algo_data->timeout = usecs_to_jiffies(2200);
+
+ ret = i2c_bit_add_numbered_bus(i2c_adapter);
+ if (ret) {
+ DRM_ERROR("Failed to register i2c algo-bit adapter %s\n",
+ i2c_adapter->name);
+ kfree(i2c_adapter);
+ i2c_adapter = NULL;
+ }
+
+ li2c->adapter = i2c_adapter;
+ i2c_algo_data->data = li2c;
+ i2c_set_adapdata(li2c->adapter, li2c);
+ DRM_INFO("Register i2c algo-bit adapter [%s]\n", i2c_adapter->name);
+
+ memset(&i2c_info, 0, sizeof(struct i2c_board_info));
+ strncpy(i2c_info.type, name, I2C_NAME_SIZE);
+ i2c_info.addr = DDC_ADDR;
+ i2c_cli = i2c_new_client_device(i2c_adapter, &i2c_info);
+ if (i2c_cli == NULL) {
+ DRM_ERROR("Failed to create i2c adapter\n");
+ return -EBUSY;
+ }
+ li2c->init = true;
+ return 0;
+
+error_mem:
+ DRM_ERROR("Failed to malloc memory for loongson i2c\n");
+ return ret;
+}
+
+static int loongson_i2c_add(struct loongson_device *ldev, const char *name)
+{
+ int i;
+
+ for (i = 0; i < LS_MAX_I2C_BUS; i++) {
+ if (ldev->i2c_bus[i].use)
+ loongson_i2c_create(&ldev->i2c_bus[i], name);
+ else {
+ DRM_DEBUG_DRIVER("i2c_bus[%d] not use\n", i);
+ return -ENODEV;
+ }
+ }
+ return 0;
+}
+
+int loongson_dc_gpio_init(struct loongson_device *ldev)
+{
+ int ret;
+ struct gpio_chip *chip;
+
+ chip = &ldev->chip;
+ chip->label = "ls7a-dc-gpio";
+ chip->base = LS7A_DC_GPIO_BASE;
+ chip->ngpio = 4;
+ chip->parent = ldev->dev->dev;
+ chip->request = ls_dc_gpio_request;
+ chip->direction_input = ls_dc_gpio_dir_input;
+ chip->direction_output = ls_dc_gpio_dir_output;
+ chip->set = ls_dc_gpio_set;
+ chip->get = ls_dc_gpio_get;
+ chip->can_sleep = false;
+
+ ret = devm_gpiochip_add_data(ldev->dev->dev, chip, ldev);
+ if (ret) {
+ DRM_ERROR("Failed to register ls7a dc gpio driver\n");
+ return -ENODEV;
+ }
+ DRM_INFO("Registered ls7a dc gpio driver\n");
+
+ return 0;
+}
+
+int loongson_i2c_init(struct loongson_device *ldev)
+{
+ int ret;
+
+ ret = gpio_request_array(i2c_gpios, ARRAY_SIZE(i2c_gpios));
+ if (ret) {
+ DRM_ERROR("Failed to request gpio array i2c_gpios\n");
+ return -ENODEV;
+ }
+
+ ldev->i2c_bus[0].i2c_id = 6;
+ ldev->i2c_bus[0].use = true;
+ ldev->i2c_bus[1].i2c_id = 7;
+ ldev->i2c_bus[1].use = true;
+
+ loongson_i2c_add(ldev, DC_I2C_NAME);
+
+ return 0;
+}
+
+struct loongson_i2c *loongson_i2c_bus_match(struct loongson_device *ldev, u32 i2c_id)
+{
+ u32 i;
+ struct loongson_i2c *match = NULL, *tables;
+
+ tables = ldev->i2c_bus;
+
+ for (i = 0; i < LS_MAX_I2C_BUS; i++) {
+ if (tables->i2c_id == i2c_id && tables->init == true) {
+ match = tables;
+ break;
+ }
+
+ tables++;
+ }
+
+ return match;
+}
+
diff --git a/drivers/gpu/drm/loongson/loongson_i2c.h b/drivers/gpu/drm/loongson/loongson_i2c.h
new file mode 100644
index 000000000000..50d4d3f4b10f
--- /dev/null
+++ b/drivers/gpu/drm/loongson/loongson_i2c.h
@@ -0,0 +1,38 @@
+/* SPDX-License-Identifier: GPL-2.0-only */
+
+#ifndef __LOONGSON_I2C_H__
+#define __LOONGSON_I2C_H__
+
+#include <linux/i2c.h>
+#include <linux/i2c-algo-bit.h>
+#include <linux/gpio/driver.h>
+#include <drm/drm_edid.h>
+
+#define DC_I2C_TON 5
+#define DC_I2C_BASE 6
+#define DC_I2C_NAME "ls_dc_i2c"
+#define LS_MAX_I2C_BUS 16
+
+/* Loongson 7A display controller proprietary GPIOs */
+#define LS7A_DC_GPIO_BASE 73
+#define DC_GPIO_0 (73)
+#define DC_GPIO_1 (74)
+#define DC_GPIO_2 (75)
+#define DC_GPIO_3 (76)
+#define LS7A_DC_GPIO_CFG_OFFSET (0x1660)
+#define LS7A_DC_GPIO_IN_OFFSET (0x1650)
+#define LS7A_DC_GPIO_OUT_OFFSET (0x1650)
+
+struct loongson_device;
+struct loongson_i2c {
+ struct i2c_adapter *adapter;
+ u32 data, clock;
+ bool use, init;
+ u32 i2c_id;
+};
+
+struct loongson_i2c *loongson_i2c_bus_match(struct loongson_device *ldev,
+ u32 i2c_id);
+int loongson_i2c_init(struct loongson_device *ldev);
+
+#endif /* __LOONGSON_I2C_H__ */
--
2.31.1
^ permalink raw reply related [flat|nested] 4+ messages in thread
end of thread, other threads:[~2021-07-06 6:44 UTC | newest]
Thread overview: 4+ messages (download: mbox.gz / follow: Atom feed)
-- links below jump to the message on this page --
2021-06-05 6:20 [PATCH 2/3] drm/loongson: Add GPIO and I2C driver for loongson drm lichenyang
-- strict thread matches above, loose matches on Subject: below --
2021-07-06 6:36 [PATCH 1/3] drm/loongson: Add DRM Driver for Loongson 7A1000 bridge chip lichenyang
2021-07-06 6:36 ` [PATCH 2/3] drm/loongson: Add GPIO and I2C driver for loongson drm lichenyang
2021-06-30 6:41 [PATCH 1/3] drm/loongson: Add DRM Driver for Loongson 7A1000 bridge chip lichenyang
2021-06-30 6:41 ` [PATCH 2/3] drm/loongson: Add GPIO and I2C driver for loongson drm lichenyang
2021-06-04 7:59 [PATCH 1/3] drm/loongson: Add DRM Driver for Loongson 7A1000 bridge chip lichenyang
2021-06-04 7:59 ` [PATCH 2/3] drm/loongson: Add GPIO and I2C driver for loongson drm lichenyang
This is an external index of several public inboxes,
see mirroring instructions on how to clone and mirror
all data and code used by this external index.