void vf_ppmgr_reg_receiver(void) { vf_reg_receiver(&ppmgr_vf_recv); }
static int d2d3_probe(struct platform_device *pdev) { int ret = 0; struct d2d3_dev_s *devp; struct resource *res; /* kmalloc d2d3 dev */ devp = kmalloc(sizeof(struct d2d3_dev_s), GFP_KERNEL); if (!devp) { printk("[d2d3]%s: failed to allocate memory for d2d3 device.\n",__func__); ret = -ENOMEM; goto failed_kmalloc_devp; } memset(devp,0,sizeof(d2d3_dev_t)); d2d3_devp = devp; //spin_lock_init(&d2d3_devp->buf_lock); d2d3_devp->flag = D2D3_BYPASS; /*disable hw&path*/ d2d3_enable_hw(false); d2d3_enable_path(false,&d2d3_devp->param); /*create cdev and register with sysfs*/ ret = d2d3_add_cdev(&devp->cdev, &d2d3_fops,0); if (ret) { printk("[d2d3]%s: failed to add device.\n",__func__); /* @todo do with error */ goto failed_add_cdev; } /*create the udev node /dev/...*/ devp->dev = d2d3_create_device(&pdev->dev,0); if (devp->dev == NULL) { printk("[d2d3]%s: device_create create error.\n",__func__); ret = -EEXIST; goto failed_create_device; } ret = device_create_file(devp->dev, &dev_attr_debug); if(ret < 0){ printk(KERN_ERR "[d2d3]%s: failed create device attr file.\n",__func__); goto failed_create_device_file; } #ifdef CONFIG_USE_OF res = &memobj; ret = find_reserve_block(pdev->dev.of_node->name,0); if(ret < 0){ pr_err("\nd2d3 memory resource undefined.\n"); return -EFAULT; } printk("[d2d3]%s: hhhhhhhhhhhhhh[%d].\n",__func__,__LINE__); res->start = (phys_addr_t)get_reserve_block_addr(ret); res->end = res->start+ (phys_addr_t)get_reserve_block_size(ret)-1; #else /* get device memory */ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); if (!res) { pr_err("[d2d3]%s: can't get memory resource.\n",__func__); ret = -EFAULT; goto failed_get_resource; } #endif devp->mem_start = res->start; devp->mem_size = res->end - res->start + 1; printk("[d2d3]%s: mem_start = 0x%x, mem_size = 0x%x.\n",__func__, devp->mem_start,devp->mem_size); #ifdef CONFIG_USE_OF if (pdev->dev.of_node) { ret = of_property_read_u32(pdev->dev.of_node,"irq",&(res->start)); if(ret) { pr_err("don't find d2d3 match irq\n"); goto failed_get_resource; } res->end = res->start; res->flags = IORESOURCE_IRQ; } #else /*get d2d3's irq*/ res = platform_get_resource(pdev,IORESOURCE_MEM,0); if (!res) { pr_err("[d2d3]%s: can't get irq resource.\n",__func__); ret = -EFAULT; goto failed_get_resource; } #endif devp->irq = res->start; sprintf(devp->vfm_name,"%s",VFM_NAME); platform_set_drvdata(pdev,(void *)devp); dev_set_drvdata(devp->dev,(void *)devp); vf_receiver_init(&d2d3_vf_recv, devp->vfm_name, &d2d3_vf_receiver, NULL); vf_reg_receiver(&d2d3_vf_recv); vf_provider_init(&d2d3_vf_prov, devp->vfm_name, &d2d3_vf_provider, NULL); return ret; failed_get_resource: device_remove_file(&pdev->dev,&dev_attr_debug); failed_create_device_file: device_del(&pdev->dev); failed_create_device: cdev_del(&devp->cdev); failed_add_cdev: kfree(devp); failed_kmalloc_devp: return ret; }