GOSTSec
/
sgminer
mirror of https://github.com/GOSTSec/sgminer
1
0
Fork 0
Code Issues Releases Wiki Activity
Browse Source

Style police on libztex.c.

nfactor-troky
Con Kolivas 13 years ago
parent
46faefbe82
commit
bd46119c11
1 changed files with 81 additions and 65 deletions
Whitespace
Show all changes Ignore whitespace when comparing lines Ignore changes in amount of whitespace Ignore changes in whitespace at EOL
Unified View
Diff Options
Show Stats Download Patch File Download Diff File
  1. 144
      libztex.c

144
libztex.c
Unescape View File

@ -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);
} }

Write Preview
Loading…
Cancel
Save