@@ -200,6 +200,8 @@ struct sh_mobile_lcdc_overlay {
unsigned int pitch;
int pos_x;
int pos_y;
+
+ bool overlay_sysfs_attrs_enabled;
};
struct sh_mobile_lcdc_priv {
@@ -1504,10 +1506,16 @@ static void
sh_mobile_lcdc_overlay_fb_unregister(struct sh_mobile_lcdc_overlay *ovl)
{
struct fb_info *info = ovl->info;
+ unsigned int i;
if (info == NULL || info->dev == NULL)
return;
+ if (ovl->overlay_sysfs_attrs_enabled) {
+ for (i = 0; i < ARRAY_SIZE(overlay_sysfs_attrs); ++i)
+ device_remove_file(info->dev, &overlay_sysfs_attrs[i]);
+ ovl->overlay_sysfs_attrs_enabled = false;
+ }
unregister_framebuffer(ovl->info);
}
@@ -1516,7 +1524,7 @@ sh_mobile_lcdc_overlay_fb_register(struct sh_mobile_lcdc_overlay *ovl)
{
struct sh_mobile_lcdc_priv *lcdc = ovl->channel->lcdc;
struct fb_info *info = ovl->info;
- unsigned int i;
+ int i, error = 0;
int ret;
if (info == NULL)
@@ -1530,10 +1538,19 @@ sh_mobile_lcdc_overlay_fb_register(struct sh_mobile_lcdc_overlay *ovl)
dev_name(lcdc->dev), ovl->index, info->var.xres,
info->var.yres, info->var.bits_per_pixel);
+ ovl->overlay_sysfs_attrs_enabled = true;
+
for (i = 0; i < ARRAY_SIZE(overlay_sysfs_attrs); ++i) {
- ret = device_create_file(info->dev, &overlay_sysfs_attrs[i]);
- if (ret < 0)
- return ret;
+ error = device_create_file(info->dev, &overlay_sysfs_attrs[i]);
+ if (error)
+ break;
+ }
+
+ if (error) {
+ while (--i >= 0)
+ device_remove_file(info->dev, &overlay_sysfs_attrs[i]);
+ ovl->overlay_sysfs_attrs_enabled = false;
+ return error;
}
return 0;