Commit c6384c88 authored by Daniel Drake's avatar Daniel Drake Committed by Mauro Carvalho Chehab

[media] via-camera: Fix OLPC serial check

The code that checks the OLPC serial port is never built at the moment,
because CONFIG_OLPC_XO_1_5 doesn't exist and probably won't be added.

Fix it so that it gets compiled in, only executes on OLPC laptops, and
move the check into the probe routine.

The compiler is smart enough to eliminate this code when CONFIG_OLPC=n
(due to machine_is_olpc() always returning false).
Signed-off-by: default avatarDaniel Drake <dsd@laptop.org>
Acked-by: default avatarJonathan Corbet <corbet@lwn.net>
Signed-off-by: default avatarMauro Carvalho Chehab <mchehab@redhat.com>
parent 4a1cba51
...@@ -25,6 +25,7 @@ ...@@ -25,6 +25,7 @@
#include <linux/via-core.h> #include <linux/via-core.h>
#include <linux/via-gpio.h> #include <linux/via-gpio.h>
#include <linux/via_i2c.h> #include <linux/via_i2c.h>
#include <asm/olpc.h>
#include "via-camera.h" #include "via-camera.h"
...@@ -38,14 +39,12 @@ MODULE_PARM_DESC(flip_image, ...@@ -38,14 +39,12 @@ MODULE_PARM_DESC(flip_image,
"If set, the sensor will be instructed to flip the image " "If set, the sensor will be instructed to flip the image "
"vertically."); "vertically.");
#ifdef CONFIG_OLPC_XO_1_5
static int override_serial; static int override_serial;
module_param(override_serial, bool, 0444); module_param(override_serial, bool, 0444);
MODULE_PARM_DESC(override_serial, MODULE_PARM_DESC(override_serial,
"The camera driver will normally refuse to load if " "The camera driver will normally refuse to load if "
"the XO 1.5 serial port is enabled. Set this option " "the XO 1.5 serial port is enabled. Set this option "
"to force the issue."); "to force-enable the camera.");
#endif
/* /*
* Basic window sizes. * Basic window sizes.
...@@ -1317,6 +1316,37 @@ static struct video_device viacam_v4l_template = { ...@@ -1317,6 +1316,37 @@ static struct video_device viacam_v4l_template = {
.release = video_device_release_empty, /* Check this */ .release = video_device_release_empty, /* Check this */
}; };
/*
* The OLPC folks put the serial port on the same pin as
* the camera. They also get grumpy if we break the
* serial port and keep them from using it. So we have
* to check the serial enable bit and not step on it.
*/
#define VIACAM_SERIAL_DEVFN 0x88
#define VIACAM_SERIAL_CREG 0x46
#define VIACAM_SERIAL_BIT 0x40
static __devinit bool viacam_serial_is_enabled(void)
{
struct pci_bus *pbus = pci_find_bus(0, 0);
u8 cbyte;
pci_bus_read_config_byte(pbus, VIACAM_SERIAL_DEVFN,
VIACAM_SERIAL_CREG, &cbyte);
if ((cbyte & VIACAM_SERIAL_BIT) == 0)
return false; /* Not enabled */
if (override_serial == 0) {
printk(KERN_NOTICE "Via camera: serial port is enabled, " \
"refusing to load.\n");
printk(KERN_NOTICE "Specify override_serial=1 to force " \
"module loading.\n");
return true;
}
printk(KERN_NOTICE "Via camera: overriding serial port\n");
pci_bus_write_config_byte(pbus, VIACAM_SERIAL_DEVFN,
VIACAM_SERIAL_CREG, cbyte & ~VIACAM_SERIAL_BIT);
return false;
}
static __devinit int viacam_probe(struct platform_device *pdev) static __devinit int viacam_probe(struct platform_device *pdev)
{ {
...@@ -1348,6 +1378,10 @@ static __devinit int viacam_probe(struct platform_device *pdev) ...@@ -1348,6 +1378,10 @@ static __devinit int viacam_probe(struct platform_device *pdev)
printk(KERN_ERR "viacam: No I/O memory, so no pictures\n"); printk(KERN_ERR "viacam: No I/O memory, so no pictures\n");
return -ENOMEM; return -ENOMEM;
} }
if (machine_is_olpc() && viacam_serial_is_enabled())
return -EBUSY;
/* /*
* Basic structure initialization. * Basic structure initialization.
*/ */
...@@ -1459,7 +1493,6 @@ static __devexit int viacam_remove(struct platform_device *pdev) ...@@ -1459,7 +1493,6 @@ static __devexit int viacam_remove(struct platform_device *pdev)
return 0; return 0;
} }
static struct platform_driver viacam_driver = { static struct platform_driver viacam_driver = {
.driver = { .driver = {
.name = "viafb-camera", .name = "viafb-camera",
...@@ -1468,50 +1501,8 @@ static struct platform_driver viacam_driver = { ...@@ -1468,50 +1501,8 @@ static struct platform_driver viacam_driver = {
.remove = viacam_remove, .remove = viacam_remove,
}; };
#ifdef CONFIG_OLPC_XO_1_5
/*
* The OLPC folks put the serial port on the same pin as
* the camera. They also get grumpy if we break the
* serial port and keep them from using it. So we have
* to check the serial enable bit and not step on it.
*/
#define VIACAM_SERIAL_DEVFN 0x88
#define VIACAM_SERIAL_CREG 0x46
#define VIACAM_SERIAL_BIT 0x40
static __devinit int viacam_check_serial_port(void)
{
struct pci_bus *pbus = pci_find_bus(0, 0);
u8 cbyte;
pci_bus_read_config_byte(pbus, VIACAM_SERIAL_DEVFN,
VIACAM_SERIAL_CREG, &cbyte);
if ((cbyte & VIACAM_SERIAL_BIT) == 0)
return 0; /* Not enabled */
if (override_serial == 0) {
printk(KERN_NOTICE "Via camera: serial port is enabled, " \
"refusing to load.\n");
printk(KERN_NOTICE "Specify override_serial=1 to force " \
"module loading.\n");
return -EBUSY;
}
printk(KERN_NOTICE "Via camera: overriding serial port\n");
pci_bus_write_config_byte(pbus, VIACAM_SERIAL_DEVFN,
VIACAM_SERIAL_CREG, cbyte & ~VIACAM_SERIAL_BIT);
return 0;
}
#endif
static int viacam_init(void) static int viacam_init(void)
{ {
#ifdef CONFIG_OLPC_XO_1_5
if (viacam_check_serial_port())
return -EBUSY;
#endif
return platform_driver_register(&viacam_driver); return platform_driver_register(&viacam_driver);
} }
module_init(viacam_init); module_init(viacam_init);
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment