From: Antonio Ospite Date: Wed, 7 May 2014 16:01:58 +0000 (+0200) Subject: am7xxx: implement the set_zoom_mode() operation for the PicoPix 2055 X-Git-Tag: v0.1.5~10^2~2 X-Git-Url: https://git.ao2.it/libam7xxx.git/commitdiff_plain/25f3a9107b11f84ad5b94335bc15beabaaac8d4b am7xxx: implement the set_zoom_mode() operation for the PicoPix 2055 Apparently AM7XXX_ZOOM_ORIGINAL and AM7XXX_ZOOM_TELE are the only supported zoom modes on the PicoPix 2055. --- diff --git a/src/am7xxx.c b/src/am7xxx.c index 6fbee5c..ffdd59c 100644 --- a/src/am7xxx.c +++ b/src/am7xxx.c @@ -26,6 +26,7 @@ #include "am7xxx.h" #include "serialize.h" +#include "tools.h" #define ARRAY_SIZE(x) (sizeof(x) / sizeof((x)[0])) @@ -81,6 +82,7 @@ struct am7xxx_usb_device_descriptor { static int default_set_power_mode(am7xxx_device *dev, am7xxx_power_mode power); static int picopix_set_power_mode(am7xxx_device *dev, am7xxx_power_mode power); static int default_set_zoom_mode(am7xxx_device *dev, am7xxx_zoom_mode zoom); +static int picopix_set_zoom_mode(am7xxx_device *dev, am7xxx_zoom_mode zoom); #define DEFAULT_OPS { \ .set_power_mode = default_set_power_mode, \ @@ -128,6 +130,7 @@ static const struct am7xxx_usb_device_descriptor supported_devices[] = { .interface_number = 0, .ops = { .set_power_mode = picopix_set_power_mode, + .set_zoom_mode = picopix_set_zoom_mode, }, }, { @@ -170,6 +173,8 @@ typedef enum { AM7XXX_PACKET_TYPE_PICOPIX_POWER_LOW = 0x15, AM7XXX_PACKET_TYPE_PICOPIX_POWER_MEDIUM = 0x16, AM7XXX_PACKET_TYPE_PICOPIX_POWER_HIGH = 0x17, + AM7XXX_PACKET_TYPE_PICOPIX_ENABLE_TI = 0x18, + AM7XXX_PACKET_TYPE_PICOPIX_DISABLE_TI = 0x19, } am7xxx_packet_type; struct am7xxx_generic_header { @@ -962,6 +967,41 @@ static int default_set_zoom_mode(am7xxx_device *dev, am7xxx_zoom_mode zoom) return 0; } +static int picopix_set_zoom_mode(am7xxx_device *dev, am7xxx_zoom_mode zoom) +{ + int ret; + am7xxx_packet_type packet_type; + + switch(zoom) { + case AM7XXX_ZOOM_ORIGINAL: + packet_type = AM7XXX_PACKET_TYPE_PICOPIX_DISABLE_TI; + break; + + case AM7XXX_ZOOM_TELE: + packet_type = AM7XXX_PACKET_TYPE_PICOPIX_ENABLE_TI; + break; + + case AM7XXX_ZOOM_H: + case AM7XXX_ZOOM_H_V: + case AM7XXX_ZOOM_TEST: + default: + error(dev->ctx, "Unsupported zoom mode.\n"); + return -EINVAL; + }; + + ret = send_command(dev, packet_type); + if (ret < 0) + return ret; + + /* The Windows drivers wait for 100ms and send the same command again, + * probably to overcome a firmware deficiency */ + ret = msleep(100); + if (ret < 0) + return ret; + + return send_command(dev, packet_type); +} + /* Public API */ AM7XXX_PUBLIC int am7xxx_init(am7xxx_context **ctx)