Browse Source

Style police on libztex.c.

nfactor-troky
Con Kolivas 13 years ago
parent
commit
bd46119c11
  1. 146
      libztex.c

146
libztex.c

@ -44,10 +44,11 @@
static bool libztex_checkDevice (struct libusb_device *dev) { static bool libztex_checkDevice(struct libusb_device *dev)
{
struct libusb_device_descriptor desc;
int err; int err;
struct libusb_device_descriptor desc;
err = libusb_get_device_descriptor(dev, &desc); err = libusb_get_device_descriptor(dev, &desc);
if (unlikely(err != 0)) { if (unlikely(err != 0)) {
applog(LOG_ERR, "Ztex check device: Failed to open read descriptor with error %d", err); applog(LOG_ERR, "Ztex check device: Failed to open read descriptor with error %d", err);
@ -60,30 +61,34 @@ static bool libztex_checkDevice (struct libusb_device *dev) {
return true; return true;
} }
static bool libztex_checkCapability (struct libztex_device *ztex, int i, int j) { static bool libztex_checkCapability(struct libztex_device *ztex, int i, int j)
if (!((i>=0) && (i<=5) && (j>=0) && (j<8) && {
if (!((i >= 0) && (i <= 5) && (j >= 0) && (j < 8) &&
(((ztex->interfaceCapabilities[i] & 255) & (1 << j)) != 0))) (((ztex->interfaceCapabilities[i] & 255) & (1 << j)) != 0)))
applog(LOG_ERR, "%s: capability missing: %d %d", ztex->repr, i, i); applog(LOG_ERR, "%s: capability missing: %d %d", ztex->repr, i, i);
return true; return true;
} }
static int libztex_detectBitstreamBitOrder (const unsigned char *buf, int size) { static int libztex_detectBitstreamBitOrder(const unsigned char *buf, int size)
{
int i; int i;
size -= 4;
for (i=0; i<size; i++) { for (i = 0; i < size - 4; i++) {
if ( ((buf[i] & 255)==0xaa) && ((buf[i+1] & 255)==0x99) && ((buf[i+2] & 255)==0x55) && ((buf[i+3] & 255)==0x66) ) if (((buf[i] & 255) == 0xaa) && ((buf[i + 1] & 255) == 0x99) && ((buf[i + 2] & 255) == 0x55) && ((buf[i + 3] & 255) == 0x66))
return 1; return 1;
if ( ((buf[i] & 255)==0x55) && ((buf[i+1] & 255)==0x99) && ((buf[i+2] & 255)==0xaa) && ((buf[i+3] & 255)==0x66) ) if (((buf[i] & 255) == 0x55) && ((buf[i + 1] & 255) == 0x99) && ((buf[i + 2] & 255) == 0xaa) && ((buf[i + 3] & 255) == 0x66))
return 0; return 0;
} }
applog(LOG_WARNING, "Unable to determine bitstream bit order: no signature found"); applog(LOG_WARNING, "Unable to determine bitstream bit order: no signature found");
return 0; return 0;
} }
static void libztex_swapBits (unsigned char *buf, int size) { static void libztex_swapBits(unsigned char *buf, int size)
int i; {
unsigned char c; unsigned char c;
for (i=0; i<size; i++) { int i;
for (i = 0; i < size; i++) {
c = buf[i]; c = buf[i];
buf[i] = ((c & 128) >> 7) | buf[i] = ((c & 128) >> 7) |
((c & 64) >> 5) | ((c & 64) >> 5) |
@ -96,9 +101,11 @@ static void libztex_swapBits (unsigned char *buf, int size) {
} }
} }
static int libztex_getFpgaState (struct libztex_device *ztex, struct libztex_fpgastate *state) { static int libztex_getFpgaState(struct libztex_device *ztex, struct libztex_fpgastate *state)
int cnt; {
unsigned char buf[9]; unsigned char buf[9];
int cnt;
if (!libztex_checkCapability(ztex, CAPABILITY_FPGA)) if (!libztex_checkCapability(ztex, CAPABILITY_FPGA))
return -1; return -1;
cnt = libusb_control_transfer(ztex->hndl, 0xc0, 0x30, 0, 0, buf, 9, 1000); cnt = libusb_control_transfer(ztex->hndl, 0xc0, 0x30, 0, 0, buf, 9, 1000);
@ -108,19 +115,20 @@ static int libztex_getFpgaState (struct libztex_device *ztex, struct libztex_fpg
} }
state->fpgaConfigured = (buf[0] == 0); state->fpgaConfigured = (buf[0] == 0);
state->fpgaChecksum = buf[1] & 0xff; state->fpgaChecksum = buf[1] & 0xff;
state->fpgaBytes = ((buf[5] & 0xff)<<24) | ((buf[4] & 0xff)<<16) | ((buf[3] & 0xff)<<8) | (buf[2] & 0xff); state->fpgaBytes = ((buf[5] & 0xff) << 24) | ((buf[4] & 0xff) << 16) | ((buf[3] & 0xff) << 8) | (buf[2] & 0xff);
state->fpgaInitB = buf[6] & 0xff; state->fpgaInitB = buf[6] & 0xff;
state->fpgaFlashResult = buf[7]; state->fpgaFlashResult = buf[7];
state->fpgaFlashBitSwap = (buf[8] != 0); state->fpgaFlashBitSwap = (buf[8] != 0);
return 0; return 0;
} }
static int libztex_configureFpgaLS (struct libztex_device *ztex, const char* firmware, bool force, char bs) { static int libztex_configureFpgaLS(struct libztex_device *ztex, const char* firmware, bool force, char bs)
{
struct libztex_fpgastate state; struct libztex_fpgastate state;
ssize_t pos=0; const int transactionBytes = 2048;
int transactionBytes = 2048;
unsigned char buf[transactionBytes], cs; unsigned char buf[transactionBytes], cs;
int tries, cnt, buf_p, i; int tries, cnt, buf_p, i;
ssize_t pos = 0;
FILE *fp; FILE *fp;
if (!libztex_checkCapability(ztex, CAPABILITY_FPGA)) if (!libztex_checkCapability(ztex, CAPABILITY_FPGA))
@ -132,8 +140,7 @@ static int libztex_configureFpgaLS (struct libztex_device *ztex, const char* fir
return 1; return 1;
} }
for (tries=10; tries>0; tries--) { for (tries = 10; tries > 0; tries--) {
fp = fopen(firmware, "rb"); fp = fopen(firmware, "rb");
if (!fp) { if (!fp) {
applog(LOG_ERR, "%s: failed to read firmware '%s'", ztex->repr, firmware); applog(LOG_ERR, "%s: failed to read firmware '%s'", ztex->repr, firmware);
@ -144,12 +151,13 @@ static int libztex_configureFpgaLS (struct libztex_device *ztex, const char* fir
while (pos < transactionBytes && !feof(fp)) { while (pos < transactionBytes && !feof(fp)) {
buf[pos] = getc(fp); buf[pos] = getc(fp);
cs += buf[pos++]; cs += buf[pos++];
}; }
if (feof(fp)) if (feof(fp))
pos--; pos--;
if ( bs != 0 && bs != 1 ) if (bs != 0 && bs != 1)
bs = libztex_detectBitstreamBitOrder(buf, transactionBytes<pos ? transactionBytes : pos); bs = libztex_detectBitstreamBitOrder(buf, transactionBytes < pos? transactionBytes: pos);
//* Reset fpga //* Reset fpga
cnt = libztex_resetFpga(ztex); cnt = libztex_resetFpga(ztex);
@ -158,14 +166,14 @@ static int libztex_configureFpgaLS (struct libztex_device *ztex, const char* fir
continue; continue;
} }
if ( bs == 1 ) if (bs == 1)
libztex_swapBits(buf, pos); libztex_swapBits(buf, pos);
buf_p = pos; buf_p = pos;
while (1) { while (1) {
i = 0; i = 0;
while (i < buf_p) { while (i < buf_p) {
cnt = libusb_control_transfer(ztex->hndl, 0x40, 0x32, 0, 0, &buf[i], buf_p-i, 5000); cnt = libusb_control_transfer(ztex->hndl, 0x40, 0x32, 0, 0, &buf[i], buf_p - i, 5000);
if (unlikely(cnt < 0)) { if (unlikely(cnt < 0)) {
applog(LOG_ERR, "%s: Failed send fpga data with err %d", ztex->repr, cnt); applog(LOG_ERR, "%s: Failed send fpga data with err %d", ztex->repr, cnt);
break; break;
@ -178,13 +186,13 @@ static int libztex_configureFpgaLS (struct libztex_device *ztex, const char* fir
while (buf_p < transactionBytes && !feof(fp)) { while (buf_p < transactionBytes && !feof(fp)) {
buf[buf_p] = getc(fp); buf[buf_p] = getc(fp);
cs += buf[buf_p++]; cs += buf[buf_p++];
}; }
if (feof(fp)) if (feof(fp))
buf_p--; buf_p--;
pos += buf_p; pos += buf_p;
if (buf_p == 0) if (buf_p == 0)
break; break;
if ( bs == 1 ) if (bs == 1)
libztex_swapBits(buf, buf_p); libztex_swapBits(buf, buf_p);
} }
if (cnt >= 0) if (cnt >= 0)
@ -202,19 +210,21 @@ static int libztex_configureFpgaLS (struct libztex_device *ztex, const char* fir
return 0; return 0;
} }
int libztex_configureFpga (struct libztex_device *ztex) { int libztex_configureFpga(struct libztex_device *ztex)
int rv; {
char buf[256] = "bitstreams/"; char buf[256] = "bitstreams/";
memset(&buf[11], 0, 245); memset(&buf[11], 0, 245);
strcpy(&buf[11], ztex->bitFileName); strcpy(&buf[11], ztex->bitFileName);
strcpy(&buf[strlen(buf)], ".bit"); strcpy(&buf[strlen(buf)], ".bit");
rv = libztex_configureFpgaLS(ztex, buf, true, 2); return libztex_configureFpgaLS(ztex, buf, true, 2);
return rv;
} }
int libztex_setFreq (struct libztex_device *ztex, uint16_t freq) { int libztex_setFreq(struct libztex_device *ztex, uint16_t freq)
{
int cnt; int cnt;
if (freq > ztex->freqMaxM) if (freq > ztex->freqMaxM)
freq = ztex->freqMaxM; freq = ztex->freqMaxM;
@ -229,19 +239,21 @@ int libztex_setFreq (struct libztex_device *ztex, uint16_t freq) {
return 0; return 0;
} }
int libztex_resetFpga (struct libztex_device *ztex) { int libztex_resetFpga(struct libztex_device *ztex)
{
return libusb_control_transfer(ztex->hndl, 0x40, 0x31, 0, 0, NULL, 0, 1000); return libusb_control_transfer(ztex->hndl, 0x40, 0x31, 0, 0, NULL, 0, 1000);
} }
int libztex_prepare_device (struct libusb_device *dev, struct libztex_device** ztex) { int libztex_prepare_device(struct libusb_device *dev, struct libztex_device** ztex)
{
struct libztex_device *newdev; struct libztex_device *newdev;
int cnt, err;
unsigned char buf[64]; unsigned char buf[64];
int cnt, err;
newdev = malloc(sizeof(struct libztex_device)); newdev = malloc(sizeof(struct libztex_device));
newdev->bitFileName = NULL;
newdev->valid = false; newdev->valid = false;
newdev->hndl = NULL; newdev->hndl = NULL;
newdev->bitFileName = NULL;
*ztex = newdev; *ztex = newdev;
err = libusb_get_device_descriptor(dev, &newdev->descriptor); err = libusb_get_device_descriptor(dev, &newdev->descriptor);
@ -264,7 +276,7 @@ int libztex_prepare_device (struct libusb_device *dev, struct libztex_device** z
} }
cnt = libusb_get_string_descriptor_ascii (newdev->hndl, newdev->descriptor.iSerialNumber, newdev->snString, cnt = libusb_get_string_descriptor_ascii (newdev->hndl, newdev->descriptor.iSerialNumber, newdev->snString,
LIBZTEX_SNSTRING_LEN+1); LIBZTEX_SNSTRING_LEN + 1);
if (unlikely(cnt < 0)) { if (unlikely(cnt < 0)) {
applog(LOG_ERR, "Ztex check device: Failed to read device snString with err %d", cnt); applog(LOG_ERR, "Ztex check device: Failed to read device snString with err %d", cnt);
return cnt; return cnt;
@ -276,7 +288,7 @@ int libztex_prepare_device (struct libusb_device *dev, struct libztex_device** z
return cnt; return cnt;
} }
if ( buf[0]!=40 || buf[1]!=1 || buf[2]!='Z' || buf[3]!='T' || buf[4]!='E' || buf[5]!='X' ) { if ( buf[0] != 40 || buf[1] != 1 || buf[2] != 'Z' || buf[3] != 'T' || buf[4] != 'E' || buf[5] != 'X' ) {
applog(LOG_ERR, "Ztex check device: Error reading ztex descriptor"); applog(LOG_ERR, "Ztex check device: Error reading ztex descriptor");
return 2; return 2;
} }
@ -323,21 +335,21 @@ int libztex_prepare_device (struct libusb_device *dev, struct libztex_device** z
newdev->numNonces = buf[1] + 1; newdev->numNonces = buf[1] + 1;
newdev->offsNonces = ((buf[2] & 255) | ((buf[3] & 255) << 8)) - 10000; newdev->offsNonces = ((buf[2] & 255) | ((buf[3] & 255) << 8)) - 10000;
newdev->freqM1 = ( (buf[4] & 255) | ((buf[5] & 255) << 8) ) * 0.01; newdev->freqM1 = ((buf[4] & 255) | ((buf[5] & 255) << 8) ) * 0.01;
newdev->freqMaxM = (buf[7] & 255); newdev->freqMaxM = (buf[7] & 255);
newdev->freqM = (buf[6] & 255); newdev->freqM = (buf[6] & 255);
newdev->freqMDefault = newdev->freqM; newdev->freqMDefault = newdev->freqM;
for (cnt=0; cnt<255; cnt++) { for (cnt=0; cnt < 255; cnt++) {
newdev->errorCount[cnt] = 0; newdev->errorCount[cnt] = 0;
newdev->errorWeight[cnt] = 0; newdev->errorWeight[cnt] = 0;
newdev->errorRate[cnt] = 0; newdev->errorRate[cnt] = 0;
newdev->maxErrorRate[cnt] = 0; newdev->maxErrorRate[cnt] = 0;
} }
cnt = strlen((char *)&buf[buf[0]==4?10:8]); cnt = strlen((char *)&buf[buf[0] == 4? 10: 8]);
newdev->bitFileName = malloc(sizeof(char)*(cnt+1)); newdev->bitFileName = malloc(sizeof(char) * (cnt + 1));
memcpy(newdev->bitFileName, &buf[buf[0]==4?10:8], cnt+1); memcpy(newdev->bitFileName, &buf[buf[0] == 4? 10: 8], cnt + 1);
newdev->usbbus = libusb_get_bus_number(dev); newdev->usbbus = libusb_get_bus_number(dev);
newdev->usbaddress = libusb_get_device_address(dev); newdev->usbaddress = libusb_get_device_address(dev);
@ -346,7 +358,8 @@ int libztex_prepare_device (struct libusb_device *dev, struct libztex_device** z
return 0; return 0;
} }
void libztex_destroy_device (struct libztex_device* ztex) { void libztex_destroy_device(struct libztex_device* ztex)
{
if (ztex->hndl != NULL) { if (ztex->hndl != NULL) {
libusb_close(ztex->hndl); libusb_close(ztex->hndl);
ztex->hndl = NULL; ztex->hndl = NULL;
@ -358,20 +371,21 @@ void libztex_destroy_device (struct libztex_device* ztex) {
free(ztex); free(ztex);
} }
int libztex_scanDevices (struct libztex_dev_list*** devs_p) { int libztex_scanDevices(struct libztex_dev_list*** devs_p)
libusb_device **list; {
int usbdevices[LIBZTEX_MAX_DESCRIPTORS];
struct libztex_dev_list **devs;
struct libztex_device *ztex; struct libztex_device *ztex;
ssize_t cnt = libusb_get_device_list(NULL, &list);
ssize_t i = 0;
int found = 0, pos = 0, err; int found = 0, pos = 0, err;
libusb_device **list;
ssize_t cnt, i = 0;
cnt = libusb_get_device_list(NULL, &list);
if (unlikely(cnt < 0)) { if (unlikely(cnt < 0)) {
applog(LOG_ERR, "Ztex scan devices: Failed to list usb devices with err %d", cnt); applog(LOG_ERR, "Ztex scan devices: Failed to list usb devices with err %d", cnt);
return 0; return 0;
} }
int usbdevices[LIBZTEX_MAX_DESCRIPTORS];
for (i = 0; i < cnt; i++) { for (i = 0; i < cnt; i++) {
if (libztex_checkDevice(list[i])) { if (libztex_checkDevice(list[i])) {
// Got one! // Got one!
@ -380,7 +394,6 @@ int libztex_scanDevices (struct libztex_dev_list*** devs_p) {
} }
} }
struct libztex_dev_list **devs;
devs = malloc(sizeof(struct libztex_dev_list *) * found); devs = malloc(sizeof(struct libztex_dev_list *) * found);
if (devs == NULL) { if (devs == NULL) {
applog(LOG_ERR, "Ztex scan devices: Failed to allocate memory"); applog(LOG_ERR, "Ztex scan devices: Failed to allocate memory");
@ -400,7 +413,7 @@ int libztex_scanDevices (struct libztex_dev_list*** devs_p) {
devs[pos]->dev = ztex; devs[pos]->dev = ztex;
devs[pos]->next = NULL; devs[pos]->next = NULL;
if (pos > 0) if (pos > 0)
devs[pos-1]->next = devs[pos]; devs[pos - 1]->next = devs[pos];
pos++; pos++;
} }
@ -409,8 +422,10 @@ int libztex_scanDevices (struct libztex_dev_list*** devs_p) {
return pos; return pos;
} }
int libztex_sendHashData (struct libztex_device *ztex, unsigned char *sendbuf) { int libztex_sendHashData(struct libztex_device *ztex, unsigned char *sendbuf)
{
int cnt; int cnt;
if (ztex == NULL || ztex->hndl == NULL) if (ztex == NULL || ztex->hndl == NULL)
return 0; return 0;
cnt = libusb_control_transfer(ztex->hndl, 0x40, 0x80, 0, 0, sendbuf, 44, 1000); cnt = libusb_control_transfer(ztex->hndl, 0x40, 0x80, 0, 0, sendbuf, 44, 1000);
@ -420,34 +435,37 @@ int libztex_sendHashData (struct libztex_device *ztex, unsigned char *sendbuf) {
return cnt; return cnt;
} }
int libztex_readHashData (struct libztex_device *ztex, struct libztex_hash_data nonces[]) { int libztex_readHashData(struct libztex_device *ztex, struct libztex_hash_data nonces[])
{
// length of buf must be 8 * (numNonces + 1) // length of buf must be 8 * (numNonces + 1)
unsigned char rbuf[12*8]; unsigned char rbuf[12 * 8];
int cnt, i; int cnt, i;
if (ztex->hndl == NULL) if (ztex->hndl == NULL)
return 0; return 0;
cnt = libusb_control_transfer(ztex->hndl, 0xc0, 0x81, 0, 0, rbuf, 12*ztex->numNonces, 1000); cnt = libusb_control_transfer(ztex->hndl, 0xc0, 0x81, 0, 0, rbuf, 12 * ztex->numNonces, 1000);
if (unlikely(cnt < 0)) { if (unlikely(cnt < 0)) {
applog(LOG_ERR, "%s: Failed readHashData with err %d", ztex->repr, cnt); applog(LOG_ERR, "%s: Failed readHashData with err %d", ztex->repr, cnt);
return cnt; return cnt;
} }
for (i=0; i<ztex->numNonces; i++) { for (i = 0; i < ztex->numNonces; i++) {
memcpy((char*)&nonces[i].goldenNonce, &rbuf[i*12], 4); memcpy((char*)&nonces[i].goldenNonce, &rbuf[i * 12], 4);
nonces[i].goldenNonce -= ztex->offsNonces; nonces[i].goldenNonce -= ztex->offsNonces;
memcpy((char*)&nonces[i].nonce, &rbuf[(i*12)+4], 4); memcpy((char*)&nonces[i].nonce, &rbuf[(i * 12) + 4], 4);
nonces[i].nonce -= ztex->offsNonces; nonces[i].nonce -= ztex->offsNonces;
memcpy((char*)&nonces[i].hash7, &rbuf[(i*12)+8], 4); memcpy((char*)&nonces[i].hash7, &rbuf[(i * 12) + 8], 4);
} }
return cnt; return cnt;
} }
void libztex_freeDevList (struct libztex_dev_list **devs) { void libztex_freeDevList(struct libztex_dev_list **devs)
ssize_t cnt = 0; {
bool done = false; bool done = false;
ssize_t cnt = 0;
while (!done) { while (!done) {
if (devs[cnt]->next == NULL) if (devs[cnt]->next == NULL)
done = true; done = true;
@ -455,5 +473,3 @@ void libztex_freeDevList (struct libztex_dev_list **devs) {
} }
free(devs); free(devs);
} }

Loading…
Cancel
Save