bfgminer/tm_i2cm.c

/*
 * Copyright 2013 gluk <glukolog@mail.ru>
 *
 * Permission is hereby granted, free of charge, to any person obtaining a copy
 * of this software and associated documentation files (the "Software"), to deal
 * in the Software without restriction, including without limitation the rights
 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
 * copies of the Software, and to permit persons to whom the Software is
 * furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in
 * all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
 * THE SOFTWARE.
 */

#include "config.h"

#include <fcntl.h>
#include <sys/ioctl.h>
#include <unistd.h>

#ifdef NEED_LINUX_I2C_H
#include <linux/i2c.h>
#endif
#include <linux/i2c-dev.h>

#include "logging.h"
#include "tm_i2c.h"
#include <sys/mman.h>

#define TM_TRIES	3

static int tm_i2c_fd;

unsigned leds = 0xFF;

static volatile unsigned *gpiom;

#define INP_GPIO(g) *(gpiom+((g)/10)) &= ~(7<<(((g)%10)*3))
#define OUT_GPIO(g) *(gpiom+((g)/10)) |=  (1<<(((g)%10)*3))
#define GPIO_SET *(gpiom+7)
#define GPIO_CLR *(gpiom+10)

unsigned char slotI2C(unsigned char slot) {
#ifdef USE_METABANK2
	unsigned char x = (slot >> 1);

	if (x == 6) return 4;
	if (x == 4) return 6;
	return x;
#else
	return slot;
#endif
}

float tm_i2c_Data2Temp(unsigned int ans) {
	float t = ans;
	return (t / 1023.0 * 3.3 * 2.0 - 2.73) * 100.0;
}

float tm_i2c_Data2Core(unsigned int ans) {
	float t = ans;
	return t / 1023.0 * 3.3;
}

int tm_i2c_init() {
	int i;
	int fd;

	fd = open("/dev/mem",O_RDWR|O_SYNC);
//	if (fd < 0) { perror("/dev/mem trouble"); return (1); }
	if (fd < 0) return (1);
	gpiom = mmap(0,4096,PROT_READ|PROT_WRITE,MAP_SHARED,fd,0x20200000);
	if (gpiom == MAP_FAILED) { perror("gpio mmap trouble"); return(1); }
	close(fd);

	for(i = 0; i < 4 ; i++) {
		INP_GPIO(i + 22); OUT_GPIO(i + 22);
		GPIO_CLR = 1 << (i + 22);
	}
	INP_GPIO(27); OUT_GPIO(27);
	INP_GPIO(17); OUT_GPIO(17);
	INP_GPIO(18); OUT_GPIO(18);

	GPIO_CLR = 1 << 27;
	usleep(1000);
	GPIO_SET = 1 << 27;

	if ((tm_i2c_fd = open("/dev/i2c-1", O_RDWR)) < 0)
		return 1;
	else
		return 0;
}

void leds_push() {
	int i;
	
	for (i = 0; i < 16; ++i)
	{
		if (leds & (1 << i))
			GPIO_SET = 1 << 17;
		else
			GPIO_CLR = 1 << 17;
		GPIO_SET = 1 << 18;
		usleep(10);
		GPIO_CLR = 1 << 18;
	}
}

void leds_set(unsigned char b) {
	leds &= ~(1 << b);
	leds_push();
}

void leds_clr(unsigned char b) {
	leds |= (1 << b);
	leds_push();
}

void tm_i2c_close() {
	close(tm_i2c_fd);
}

unsigned int tm_i2c_req(int fd, unsigned char addr, unsigned char cmd, unsigned int data) {
	int i;
	unsigned char buf[16];
	struct i2c_msg msg;
	tm_struct *tm = (tm_struct *) buf;
	struct i2c_rdwr_ioctl_data msg_rdwr;
	unsigned int ret;

	//applog(LOG_DEBUG, "fd: %d, REQ from %02X cmd: %02X", fd, addr, cmd);

	tm->cmd = cmd;
	tm->data_lsb = data & 0xFF;
	tm->data_msb = (data & 0xFF00) >> 8;

	/* Write CMD */
	msg.addr = addr;
	msg.flags = 0;
	msg.len = 3;
	msg.buf = (void*)tm;
	msg_rdwr.msgs = &msg;
	msg_rdwr.nmsgs = 1;
	if ((i = ioctl(fd, I2C_RDWR, &msg_rdwr)) < 0) {
		//perror("ioctl error");
		return -1;
	}

	/* Read result */
	msg.addr = addr;
	msg.flags = I2C_M_RD;
	msg.len = 3;
	msg.buf = (void*)tm;
	msg_rdwr.msgs = &msg;
	msg_rdwr.nmsgs = 1;
	if ((i = ioctl(fd, I2C_RDWR, &msg_rdwr)) < 0) {
		//perror("ioctl error");
		return -1;
	}

	//hexdump(buf, 10);
	ret = (tm->data_msb << 8) + tm->data_lsb;
	//printf("REQ from %02X, cmd: %02X, res: %04X\n", addr, cmd, ret);
	if (tm->cmd == cmd) return ret;
	return 0;
}

int tm_i2c_detect(unsigned char slot) {
	if (slot < 0 || slot > 31) return 0;
	leds_set(slot >> 1);
	//return tm_i2c_req(tm_i2c_fd, (TM_ADDR >> 1) + (slot >> 1), TM_GET_CORE0, 0);
	return 1;
}

float tm_i2c_getcore0(unsigned char slot) {
	int t = 0;
	float v;
	if (slot < 0 || slot > 31) return 0;
	do {
		usleep(10000);
		v = tm_i2c_Data2Core(tm_i2c_req(tm_i2c_fd, (TM_ADDR >> 1) + slotI2C(slot), TM_GET_CORE0, 0));
		t++;
	} while(t <= TM_TRIES && (v == 0 || v > 3.3));
	if (v == 0 || v > 3.3) v = -1;
	return v;
}

float tm_i2c_getcore1(unsigned char slot) {
	int t = 0;
	float v;
	if (slot < 0 || slot > 31) return 0;
	do {
		usleep(10000);
		v = tm_i2c_Data2Core(tm_i2c_req(tm_i2c_fd, (TM_ADDR >> 1) + slotI2C(slot), TM_GET_CORE1, 0));
		t++;
	} while(t <= TM_TRIES && (v == 0 || v > 3.3));
	if (v == 0 || v > 3.3) v = -1;
	return v;
}

float tm_i2c_gettemp(unsigned char slot) {
	if (slot < 0 || slot > 31) return 0;
	return tm_i2c_Data2Temp(tm_i2c_req(tm_i2c_fd, (TM_ADDR >> 1) + slotI2C(slot), TM_GET_TEMP, 0));
}
void tm_i2c_set_oe(unsigned char slot) {
	int i;

	if (slot < 0 || slot > 15) return;
	for(i = 0 ; i < 4 ; i++) {
		if (slot & (1 << i)) GPIO_SET = 1 << (i + 22);
		else GPIO_CLR = 1 << (i + 22);
	}
	GPIO_CLR = 1 << 27;
	leds ^= (1 << slot);
	leds_push();
}

void tm_i2c_clear_oe(unsigned char slot) {
	if (slot < 0 || slot > 31) return;
	GPIO_SET = 1 << 27;
}

unsigned char tm_i2c_slot2addr(unsigned char slot) {
	if (slot < 0 || slot > 31) return 0;
	return ((TM_ADDR >> 1) + slotI2C(slot));
}

#ifdef USE_METABANK2
double tm_i2c_set_voltage_abs(unsigned char slot2, double voltage) {
	int vid = 0, core_id;
	double prev = 0.0, current = 0.0;
	float (*get_core)(unsigned char);
	unsigned char slot = slotI2C(slot2);
	double eps = 0.01, eps_max=0.02;

	if ((slot2 & 1)) {
		core_id = TM_SET_CORE1;
		get_core = &tm_i2c_getcore1;
	} else {
		core_id = TM_SET_CORE0;
		get_core = &tm_i2c_getcore0;
	}
	if (get_core(slot2) <= 0) return -1;

	do {
		prev = current;
		tm_i2c_req(tm_i2c_fd, (TM_ADDR >> 1) + slot, core_id, vid);
		usleep(100000);
		current = get_core(slot2);
		vid++;
		usleep(1000);
	} while (current <= voltage && vid < 16);
	if (current - voltage <= eps) return current;
	if (current - voltage > eps_max || current - voltage > voltage - prev) {
		int tr = 0;
		double volt_chk;
		//set low
		vid -= 2;
		do {
			tm_i2c_req(tm_i2c_fd, (TM_ADDR >> 1) + slot, core_id, vid);
			usleep(100000);
			volt_chk = get_core(slot2);
			tr++;
		} while(volt_chk > current && tr < TM_TRIES);
	}
	usleep(100000);
	return get_core(slot2);
}

unsigned int tm_i2c_set_vid(unsigned char slot, unsigned char vid) {
	int tr = 0;
	unsigned int res;

	if (slot < 0 || slot > 31) return -1;
	do {
		res = tm_i2c_req(tm_i2c_fd, (TM_ADDR >> 1) + slotI2C(slot), (slot & 1) ? TM_SET_CORE1 : TM_SET_CORE0, vid);
		tr++;
	} while(tr < TM_TRIES && res < 0);
	return res;
}
#endif