static int rk610_hdmi_i2c_probe(struct i2c_client *client,const struct i2c_device_id *id) { int ret = 0; struct hdmi *hdmi = NULL; struct rk610_hdmi_inf *rk610_hdmi = NULL; struct hdmi_platform_data *pdata = client->dev.platform_data; rk610_g_hdmi_client = client; if(pdata && pdata->io_init) { printk("rk610_hdmi_i2c_probe io_init \n"); pdata->io_init(); } hdmi = hdmi_register(sizeof(struct rk610_hdmi_inf), &client->dev); if (!hdmi) { dev_err(&client->dev, "fail to register hdmi\n"); return -ENOMEM; } if(HDMI_SOURCE_DEFAULT == HDMI_SOURCE_LCDC0) hdmi->lcdc = rk_get_lcdc_drv("lcdc0"); else hdmi->lcdc = rk_get_lcdc_drv("lcdc1"); if(hdmi->lcdc == NULL) { dev_err(hdmi->dev, "can not connect to video source lcdc\n"); ret = -ENXIO; } hdmi->ops = &rk610_hdmi_ops; hdmi->display_on = HDMI_DEFAULT_MODE; hdmi->hdcp_on = HDMI_DISABLE; hdmi->audio_fs = HDMI_I2S_DEFAULT_Fs; hdmi->resolution = HDMI_DEFAULT_RESOLUTION; hdmi->dual_disp = DUAL_DISP_CAP; hdmi->mode = DISP_ON_LCD; hdmi->scale = 100; hdmi->scale_set = 100; rk610_hdmi = hdmi_priv(hdmi); rk610_hdmi->init = 1; rk610_hdmi->hdmi = hdmi; i2c_set_clientdata(client, rk610_hdmi); rk610_hdmi->client = client; if((gpio_request(client->irq, "hdmi gpio")) < 0) { dev_err(&client->dev, "fail to request gpio %d\n", client->irq); goto err_gpio_free; } rk610_hdmi->irq = gpio_to_irq(client->irq); rk610_hdmi->gpio = client->irq; gpio_direction_input(client->irq); #if 0 if((ret = request_irq(rk610_hdmi->irq, rk610_hdmi_interrupt, IRQ_TYPE_EDGE_RISING,client->name, hdmi))<0){ RK610_ERR(&client->dev, "fail to request gpio %d\n", client->irq); goto err_gpio_free; } #endif #ifdef CONFIG_HAS_EARLYSUSPEND rk610_hdmi->early_suspend.suspend = rk610_hdmi_early_suspend; rk610_hdmi->early_suspend.resume = rk610_hdmi_early_resume; rk610_hdmi->early_suspend.level = EARLY_SUSPEND_LEVEL_BLANK_SCREEN - 1; register_early_suspend(&rk610_hdmi->early_suspend); #endif #ifdef RK610_DEBUG device_create_file(&(client->dev), &rk610_attrs[0]); #endif rk610_hdmi_init(rk610_hdmi->hdmi); dev_info(&client->dev, "rk610_hdmi i2c probe ok\n"); return 0; err_gpio_free: gpio_free(client->irq); err_hdmi_unregister: hdmi_unregister(hdmi); rk610_hdmi = NULL; return ret; }
static int __devinit rk616_hdmi_probe (struct platform_device *pdev) { int ret; struct rk616_hdmi *rk616_hdmi; struct resource __maybe_unused *mem; struct resource __maybe_unused *res; rk616_hdmi = devm_kzalloc(&pdev->dev, sizeof(*rk616_hdmi), GFP_KERNEL); if(!rk616_hdmi) { dev_err(&pdev->dev, ">>rk616_hdmi kmalloc fail!"); return -ENOMEM; } hdmi = &rk616_hdmi->g_hdmi; #ifdef CONFIG_ARCH_RK3026 rk616_hdmi->rk616_drv = NULL; #else rk616_hdmi->rk616_drv = dev_get_drvdata(pdev->dev.parent); if(!(rk616_hdmi->rk616_drv)) { dev_err(&pdev->dev,"null mfd device rk616!\n"); return -ENODEV; } #endif hdmi->dev = &pdev->dev; platform_set_drvdata(pdev, hdmi); if(HDMI_SOURCE_DEFAULT == HDMI_SOURCE_LCDC0) hdmi->lcdc = rk_get_lcdc_drv("lcdc0"); else hdmi->lcdc = rk_get_lcdc_drv("lcdc1"); if(hdmi->lcdc == NULL) { dev_err(hdmi->dev, "can not connect to video source lcdc\n"); ret = -ENXIO; goto err0; } hdmi->xscale = 100; hdmi->yscale = 100; hdmi_sys_init(); hdmi->workqueue = create_singlethread_workqueue("hdmi"); INIT_DELAYED_WORK(&(hdmi->delay_work), hdmi_work); #ifdef CONFIG_HAS_EARLYSUSPEND hdmi->early_suspend.suspend = hdmi_early_suspend; hdmi->early_suspend.resume = hdmi_early_resume; hdmi->early_suspend.level = EARLY_SUSPEND_LEVEL_DISABLE_FB - 10; register_early_suspend(&hdmi->early_suspend); #endif #ifdef CONFIG_SWITCH hdmi->switch_hdmi.name="hdmi"; switch_dev_register(&(hdmi->switch_hdmi)); #endif spin_lock_init(&hdmi->irq_lock); mutex_init(&hdmi->enable_mutex); INIT_DELAYED_WORK(&rk616_hdmi->rk616_delay_work, rk616_delay_work_func); /* get the IRQ */ // if(rk616->pdata->hdmi_irq != INVALID_GPIO) #ifdef CONFIG_ARCH_RK3026 hdmi->hclk = clk_get(NULL,"pclk_hdmi"); if(IS_ERR(hdmi->hclk)) { dev_err(hdmi->dev, "Unable to get hdmi hclk\n"); ret = -ENXIO; goto err0; } clk_enable(hdmi->hclk); res = platform_get_resource(pdev, IORESOURCE_MEM, 0); if (!res) { dev_err(hdmi->dev, "Unable to get register resource\n"); ret = -ENXIO; goto err0; } hdmi->regbase_phy = res->start; hdmi->regsize_phy = (res->end - res->start) + 1; mem = request_mem_region(res->start, (res->end - res->start) + 1, pdev->name); if (!mem) { dev_err(hdmi->dev, "failed to request mem region for hdmi\n"); ret = -ENOENT; goto err0; } printk("res->start = 0x%x\n, xhc-------res->end = 0x%x\n", res->start, res->end); hdmi->regbase = (int)ioremap(res->start, (res->end - res->start) + 1); if (!hdmi->regbase) { dev_err(hdmi->dev, "cannot ioremap registers\n"); ret = -ENXIO; goto err1; } // rk30_mux_api_set(GPIO0A7_I2C3_SDA_HDMI_DDCSDA_NAME, GPIO0A_HDMI_DDCSDA); // rk30_mux_api_set(GPIO0A6_I2C3_SCL_HDMI_DDCSCL_NAME, GPIO0A_HDMI_DDCSCL); // rk30_mux_api_set(GPIO0B7_HDMI_HOTPLUGIN_NAME, GPIO0B_HDMI_HOTPLUGIN); iomux_set(HDMI_DDCSDA); iomux_set(HDMI_DDCSCL); iomux_set(HDMI_HOTPLUGIN); ret = rk616_hdmi_initial(); /* get the IRQ */ hdmi->irq = platform_get_irq(pdev, 0); if(hdmi->irq <= 0) { dev_err(hdmi->dev, "failed to get hdmi irq resource (%d).\n", hdmi->irq); hdmi->irq = 0; } else { /* request the IRQ */ ret = request_irq(hdmi->irq, rk616_hdmi_irq, 0, dev_name(&pdev->dev), hdmi); if (ret) { dev_err(hdmi->dev, "hdmi request_irq failed (%d).\n", ret); goto err1; } } #else ret = rk616_hdmi_initial(); if(rk616_hdmi->rk616_drv->pdata->hdmi_irq != INVALID_GPIO) { INIT_WORK(&rk616_hdmi->rk616_irq_work_struct, rk616_irq_work_func); ret = gpio_request(rk616_hdmi->rk616_drv->pdata->hdmi_irq,"rk616_hdmi_irq"); if(ret < 0) { dev_err(hdmi->dev,"request gpio for rk616 hdmi irq fail\n"); } gpio_direction_input(rk616_hdmi->rk616_drv->pdata->hdmi_irq); hdmi->irq = gpio_to_irq(rk616_hdmi->rk616_drv->pdata->hdmi_irq); if(hdmi->irq <= 0) { dev_err(hdmi->dev, "failed to get hdmi irq resource (%d).\n", hdmi->irq); ret = -ENXIO; goto err1; } /* request the IRQ */ ret = request_irq(hdmi->irq, rk616_hdmi_irq, IRQF_TRIGGER_LOW, dev_name(&pdev->dev), &rk616_hdmi->rk616_irq_work_struct); if (ret) { dev_err(hdmi->dev, "hdmi request_irq failed (%d).\n", ret); goto err1; } } else { /* use roll polling method */ hdmi->irq = 0; } #endif hdmi_register_display_sysfs(hdmi, NULL); #if defined(CONFIG_DEBUG_FS) if(rk616_hdmi->rk616_drv && rk616_hdmi->rk616_drv->debugfs_dir) { debugfs_create_file("hdmi", S_IRUSR, rk616_hdmi->rk616_drv->debugfs_dir, rk616_hdmi->rk616_drv, &rk616_hdmi_reg_fops); } else { rk616_hdmi->debugfs_dir = debugfs_create_dir("rk616", NULL); if (IS_ERR(rk616_hdmi->debugfs_dir)) { dev_err(hdmi->dev,"failed to create debugfs dir for rk616!\n"); } else { debugfs_create_file("hdmi", S_IRUSR, rk616_hdmi->debugfs_dir, rk616_hdmi, &rk616_hdmi_reg_fops); } } #endif //rk616_delay_work_func(NULL); queue_delayed_work(hdmi->workqueue, &rk616_hdmi->rk616_delay_work, msecs_to_jiffies(0)); dev_info(hdmi->dev, "rk616 hdmi probe success.\n"); return 0; err1: #ifdef CONFIG_SWITCH switch_dev_unregister(&(hdmi->switch_hdmi)); #endif hdmi_unregister_display_sysfs(hdmi); #ifdef CONFIG_HAS_EARLYSUSPEND unregister_early_suspend(&hdmi->early_suspend); #endif err0: hdmi_dbg(hdmi->dev, "rk616 hdmi probe error.\n"); kfree(hdmi); hdmi = NULL; return ret; }
static int cat66121_hdmi_i2c_probe(struct i2c_client *client,const struct i2c_device_id *id) { int rc = 0; struct rk_hdmi_platform_data *pdata = client->dev.platform_data; cat66121_hdmi = kzalloc(sizeof(struct cat66121_hdmi_pdata), GFP_KERNEL); if(!cat66121_hdmi) { dev_err(&client->dev, "no memory for state\n"); return -ENOMEM; } cat66121_hdmi->client = client; i2c_set_clientdata(client, cat66121_hdmi); hdmi = kmalloc(sizeof(struct hdmi), GFP_KERNEL); if(!hdmi) { dev_err(&client->dev, "cat66121 hdmi kmalloc fail!"); goto err_kzalloc_hdmi; } memset(hdmi, 0, sizeof(struct hdmi)); hdmi->dev = &client->dev; if(HDMI_SOURCE_DEFAULT == HDMI_SOURCE_LCDC0) hdmi->lcdc = rk_get_lcdc_drv("lcdc0"); else hdmi->lcdc = rk_get_lcdc_drv("lcdc1"); if(hdmi->lcdc == NULL) { dev_err(hdmi->dev, "can not connect to video source lcdc\n"); rc = -ENXIO; goto err_request_lcdc; } if(pdata->io_init){ if(pdata->io_init()<0){ dev_err(&client->dev, "fail to rst chip\n"); goto err_request_lcdc; } } if(cat66121_detect_device()!=1){ dev_err(hdmi->dev, "can't find it6610 device \n"); rc = -ENXIO; goto err_request_lcdc; } hdmi->xscale = 100; hdmi->yscale = 100; hdmi->insert = cat66121_hdmi_sys_insert; hdmi->remove = cat66121_hdmi_sys_remove; hdmi->control_output = cat66121_hdmi_sys_enalbe_output; hdmi->config_video = cat66121_hdmi_sys_config_video; hdmi->config_audio = cat66121_hdmi_sys_config_audio; hdmi->detect_hotplug = cat66121_hdmi_sys_detect_hpd; hdmi->read_edid = cat66121_hdmi_sys_read_edid; hdmi_sys_init(); hdmi->workqueue = create_singlethread_workqueue("hdmi"); INIT_DELAYED_WORK(&(hdmi->delay_work), hdmi_work); #ifdef CONFIG_HAS_EARLYSUSPEND hdmi->early_suspend.suspend = hdmi_early_suspend; hdmi->early_suspend.resume = hdmi_early_resume; hdmi->early_suspend.level = EARLY_SUSPEND_LEVEL_DISABLE_FB - 10; register_early_suspend(&hdmi->early_suspend); #endif hdmi_register_display_sysfs(hdmi, NULL); #ifdef CONFIG_SWITCH hdmi->switch_hdmi.name="hdmi"; switch_dev_register(&(hdmi->switch_hdmi)); #endif spin_lock_init(&hdmi->irq_lock); mutex_init(&hdmi->enable_mutex); cat66121_hdmi_sys_init(); #ifdef HDMI_DEBUG device_create_file(&(client->dev), &hdmi_attrs[0]); #endif #ifdef HDMI_USE_IRQ if(client->irq != INVALID_GPIO) { INIT_WORK(&cat66121_hdmi->irq_work, cat66121_irq_work_func); schedule_work(&cat66121_hdmi->irq_work); if((rc = gpio_request(client->irq, "hdmi gpio")) < 0) { dev_err(&client->dev, "fail to request gpio %d\n", client->irq); goto err_request_lcdc; } schedule_delayed_work(&check_status_work, msecs_to_jiffies(5000)); hdmi->irq = gpio_to_irq(client->irq); cat66121_hdmi->gpio = client->irq; gpio_pull_updown(client->irq, GPIOPullUp); gpio_direction_input(client->irq); if((rc = request_irq(hdmi->irq, cat66121_irq, IRQF_TRIGGER_FALLING, NULL, hdmi)) < 0) { dev_err(&client->dev, "fail to request hdmi irq\n"); goto err_request_irq; } } else #else { cat66121_hdmi->workqueue = create_singlethread_workqueue("cat66121 irq"); INIT_DELAYED_WORK(&(cat66121_hdmi->delay_work), cat66121_irq_work_func); cat66121_irq_work_func(NULL); } #endif dev_info(&client->dev, "cat66121 hdmi i2c probe ok\n"); g_hdmi_data = pdata; return 0; err_request_irq: gpio_free(client->irq); err_request_lcdc: kfree(hdmi); hdmi = NULL; err_kzalloc_hdmi: kfree(cat66121_hdmi); cat66121_hdmi = NULL; dev_err(&client->dev, "cat66121 hdmi probe error\n"); return rc; }