X-Git-Url: https://git.ao2.it/libam7xxx.git/blobdiff_plain/3339bee3f62dbfa3586cc4db5201f7fc704ab037..b9376b1fd2f4e3bd5870e6bb43c523e4b6c297d8:/src/am7xxx.c?ds=sidebyside diff --git a/src/am7xxx.c b/src/am7xxx.c index d81d1a8..90dcc8c 100644 --- a/src/am7xxx.c +++ b/src/am7xxx.c @@ -1,10 +1,10 @@ /* am7xxx - communication with AM7xxx based USB Pico Projectors and DPFs * - * Copyright (C) 2011 Antonio Ospite + * Copyright (C) 2012 Antonio Ospite * * This program is free software: you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by - * the Free Software Foundation, either version 3 of the License, or + * the Free Software Foundation, either version 2 of the License, or * (at your option) any later version. * * This program is distributed in the hope that it will be useful, @@ -17,38 +17,36 @@ */ #include -#include +#include #include #include "am7xxx.h" +#include "serialize.h" #define AM7XXX_VENDOR_ID 0x1de1 #define AM7XXX_PRODUCT_ID 0xc101 -#if 1 -static uint8_t reference_image_header[] = { - 0x02, 0x00, 0x00, 0x00, - 0x00, - 0x10, - 0x3e, - 0x10, - 0x01, 0x00, 0x00, 0x00, - 0x20, 0x03, 0x00, 0x00, - 0xe0, 0x01, 0x00, 0x00, - 0x53, 0xE8, 0x00, 0x00 -}; -#endif - static void dump_image_header(struct am7xxx_image_header *i) { if (i == NULL) return; printf("Image header:\n"); - printf("format: 0x%08x (%u)\n", i->format, i->format); - printf("width: 0x%08x (%u)\n", i->width, i->width); - printf("height: 0x%08x (%u)\n", i->height, i->height); - printf("image size: 0x%08x (%u)\n", i->image_size, i->image_size); + printf("\tformat: 0x%08x (%u)\n", i->format, i->format); + printf("\twidth: 0x%08x (%u)\n", i->width, i->width); + printf("\theight: 0x%08x (%u)\n", i->height, i->height); + printf("\timage size: 0x%08x (%u)\n", i->image_size, i->image_size); +} + +static void dump_power_header(struct am7xxx_power_header *p) +{ + if (p == NULL) + return; + + printf("Power header:\n"); + printf("\tbit2: 0x%08x (%u)\n", p->bit2, p->bit2); + printf("\tbit1: 0x%08x (%u)\n", p->bit1, p->bit1); + printf("\tbit0: 0x%08x (%u)\n", p->bit0, p->bit0); } static void dump_header(struct am7xxx_header *h) @@ -56,17 +54,21 @@ static void dump_header(struct am7xxx_header *h) if (h == NULL) return; - printf("packet_type: 0x%08x (%u)\n", h->packet_type, h->packet_type); - printf("unknown0: 0x%02hhx (%hhu)\n", h->unknown0, h->unknown0); - printf("header_len: 0x%02hhx (%hhu)\n", h->header_len, h->header_len); - printf("unknown2: 0x%02hhx (%hhu)\n", h->unknown2, h->unknown2); - printf("unknown3: 0x%02hhx (%hhu)\n", h->unknown3, h->unknown3); + printf("packet_type: 0x%08x (%u)\n", h->packet_type, h->packet_type); + printf("unknown0: 0x%02hhx (%hhu)\n", h->unknown0, h->unknown0); + printf("header_data_len: 0x%02hhx (%hhu)\n", h->header_data_len, h->header_data_len); + printf("unknown2: 0x%02hhx (%hhu)\n", h->unknown2, h->unknown2); + printf("unknown3: 0x%02hhx (%hhu)\n", h->unknown3, h->unknown3); switch(h->packet_type) { case AM7XXX_PACKET_TYPE_IMAGE: dump_image_header(&(h->header_data.image)); break; + case AM7XXX_PACKET_TYPE_POWER: + dump_power_header(&(h->header_data.power)); + break; + default: printf("Packet type not supported!\n"); break; @@ -77,6 +79,8 @@ static void dump_header(struct am7xxx_header *h) static inline unsigned int in_80chars(unsigned int i) { + /* The 3 below is the length of "xx " where xx is the hex string + * representation of a byte */ return ((i+1) % (80/3)); } @@ -98,7 +102,11 @@ static int send_data(am7xxx_device dev, uint8_t *buffer, unsigned int len) int ret; int transferred; +#if DEBUG + printf("\nsending -->\n"); dump_buffer(buffer, len); + printf("\n"); +#endif ret = libusb_bulk_transfer(dev, 1, buffer, len, &transferred, 0); if (ret != 0 || (unsigned int)transferred != len) { @@ -110,16 +118,45 @@ static int send_data(am7xxx_device dev, uint8_t *buffer, unsigned int len) return 0; } +static void serialize_header(struct am7xxx_header *h, uint8_t *buffer) +{ + uint8_t **buffer_iterator = &buffer; + + put_le32(h->packet_type, buffer_iterator); + put_8(h->unknown0, buffer_iterator); + put_8(h->header_data_len, buffer_iterator); + put_8(h->unknown2, buffer_iterator); + put_8(h->unknown3, buffer_iterator); + put_le32(h->header_data.data.field0, buffer_iterator); + put_le32(h->header_data.data.field1, buffer_iterator); + put_le32(h->header_data.data.field2, buffer_iterator); + put_le32(h->header_data.data.field3, buffer_iterator); +} + static int send_header(am7xxx_device dev, struct am7xxx_header *h) { - union { - struct am7xxx_header header; - uint8_t buffer[sizeof (struct am7xxx_header)]; - } data; + uint8_t *buffer; + int ret; + +#if DEBUG + printf("\n"); + dump_header(h); + printf("\n"); +#endif - data.header = *h; + buffer = calloc(AM7XXX_HEADER_WIRE_SIZE, 1); + if (buffer == NULL) { + perror("calloc buffer"); + return -ENOMEM; + } + + serialize_header(h, buffer); + ret = send_data(dev, buffer, AM7XXX_HEADER_WIRE_SIZE); + if (ret < 0) + fprintf(stderr, "send_header: failed to send data.\n"); - return send_data(dev, data.buffer, sizeof (struct am7xxx_header)); + free(buffer); + return ret; } am7xxx_device am7xxx_init(void) @@ -165,27 +202,21 @@ int am7xxx_send_image(am7xxx_device dev, { int ret; struct am7xxx_header h = { - .packet_type = htole32(AM7XXX_PACKET_TYPE_IMAGE), - .unknown0 = 0x00, - .header_len = sizeof(struct am7xxx_image_header), - .unknown2 = 0x3e, - .unknown3 = 0x10, + .packet_type = AM7XXX_PACKET_TYPE_IMAGE, + .unknown0 = 0x00, + .header_data_len = sizeof(struct am7xxx_image_header), + .unknown2 = 0x3e, + .unknown3 = 0x10, .header_data = { .image = { - .format = htole32(format), - .width = htole32(width), - .height = htole32(height), - .image_size = htole32(size), + .format = format, + .width = width, + .height = height, + .image_size = size, }, }, }; - dump_header(&h); - printf("\n"); - - printf("Dump Buffers\n"); - dump_buffer(reference_image_header, sizeof(struct am7xxx_header)); - ret = send_header(dev, &h); if (ret < 0) return ret; @@ -195,3 +226,56 @@ int am7xxx_send_image(am7xxx_device dev, return send_data(dev, image, size); } + +int am7xxx_set_power_mode(am7xxx_device dev, am7xxx_power_mode mode) +{ + int ret; + struct am7xxx_header h = { + .packet_type = AM7XXX_PACKET_TYPE_POWER, + .unknown0 = 0x00, + .header_data_len = sizeof(struct am7xxx_power_header), + .unknown2 = 0x3e, + .unknown3 = 0x10, + }; + + switch(mode) { + case AM7XXX_POWER_OFF: + h.header_data.power.bit2 = 0; + h.header_data.power.bit1 = 0; + h.header_data.power.bit0 = 0; + break; + + case AM7XXX_POWER_LOW: + h.header_data.power.bit2 = 0; + h.header_data.power.bit1 = 0; + h.header_data.power.bit0 = 1; + + case AM7XXX_POWER_MIDDLE: + h.header_data.power.bit2 = 0; + h.header_data.power.bit1 = 1; + h.header_data.power.bit0 = 0; + break; + + case AM7XXX_POWER_HIGH: + h.header_data.power.bit2 = 0; + h.header_data.power.bit1 = 1; + h.header_data.power.bit0 = 1; + break; + + case AM7XXX_POWER_TURBO: + h.header_data.power.bit2 = 1; + h.header_data.power.bit1 = 0; + h.header_data.power.bit0 = 0; + break; + + default: + fprintf(stderr, "Unsupported power mode.\n"); + return -EINVAL; + }; + + ret = send_header(dev, &h); + if (ret < 0) + return ret; + + return 0; +}