madmaurice/pcsensor-temper
1
0
Fork 0
mirror of https://github.com/shakemid/pcsensor-temper.git synced 2025-01-21 09:08:17 +01:00
Code Issues Projects Releases Packages Wiki Activity Actions
pcsensor-temper/pcsensor.c
shakemid 7eb9e1cdb1 Fix styles
2017-09-13 16:55:32 +09:00

415 lines
13 KiB
C
Raw Blame History

/*
* pcsensor.c by Juan Carlos Perez (c) 2011 (cray@isp-sl.com)
* based on Temper.c by Robert Kavaler (c) 2009 (relavak.com)
* All rights reserved.
*
* 2011/08/30 Thanks to EdorFaus: bugfix to support negative temperatures
* 2017/08/30 Improved by K.Cima: changed libusb-0.1 -> libusb-1.0
* https://github.com/shakemid/pcsensor
*
* Temper driver for linux. This program can be compiled either as a library
* or as a standalone program (-DUNIT_TEST). The driver will work with some
* TEMPer usb devices from RDing (www.PCsensor.com).
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions are met:
* * Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
*
* THIS SOFTWARE IS PROVIDED BY Juan Carlos Perez ''AS IS'' AND ANY
* EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
* WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
* DISCLAIMED. IN NO EVENT SHALL Robert kavaler BE LIABLE FOR ANY
* DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
* (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
* LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
* ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
* SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
*
*/
#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <ctype.h>
#include <time.h>
#include <string.h>
#include <strings.h>
#include <errno.h>
#include <signal.h>
#include <libusb.h>
#define VERSION "1.1.0"
#define VENDOR_ID 0x0c45
#define PRODUCT_ID 0x7401
#define INTERFACE1 0x00
#define INTERFACE2 0x01
#define MAX_DEV 8
const static int reqIntLen=8;
const static int reqBulkLen=8;
const static int endpoint_Int_in=0x82; /* endpoint 0x81 address for IN */
const static int endpoint_Int_out=0x00; /* endpoint 1 address for OUT */
const static int endpoint_Bulk_in=0x82; /* endpoint 0x81 address for IN */
const static int endpoint_Bulk_out=0x00; /* endpoint 1 address for OUT */
const static int timeout=5000; /* timeout in ms */
const static char uTemperature[] = { 0x01, 0x80, 0x33, 0x01, 0x00, 0x00, 0x00, 0x00 };
const static char uIni1[] = { 0x01, 0x82, 0x77, 0x01, 0x00, 0x00, 0x00, 0x00 };
const static char uIni2[] = { 0x01, 0x86, 0xff, 0x01, 0x00, 0x00, 0x00, 0x00 };
static int bsalir=1;
static int debug=0;
static int seconds=5;
static int formato=0;
static int mrtg=0;
static int calibration=0;
static libusb_context *ctx = NULL;
void bad(const char *why) {
fprintf(stderr,"Fatal error> %s\n",why);
exit(17);
}
void usb_detach(libusb_device_handle *lvr_winusb, int iInterface) {
int ret;
ret = libusb_detach_kernel_driver(lvr_winusb, iInterface);
if(ret) {
if(errno == ENODATA) {
if(debug) {
printf("Device already detached\n");
}
} else {
if(debug) {
printf("Detach failed: %s[%d]\n", strerror(errno), errno);
printf("Continuing anyway\n");
}
}
} else {
if(debug) {
printf("detach successful\n");
}
}
}
int find_lvr_winusb(libusb_device_handle **handles) {
int i, s, cnt, numdev;
libusb_device **devs;
//handle = libusb_open_device_with_vid_pid(ctx, VENDOR_ID, PRODUCT_ID);
cnt = libusb_get_device_list(ctx, &devs);
if (cnt < 1) {
fprintf(stderr, "Could not find USB device: %d\n", cnt);
}
numdev = 0;
for (i = 0; i < cnt && numdev < MAX_DEV; i++) {
struct libusb_device_descriptor desc;
if ((s = libusb_get_device_descriptor(devs[i], &desc)) < 0) {
fprintf(stderr, "Could not get USB device descriptor: %d\n", s);
continue;
}
if (desc.idVendor == VENDOR_ID && desc.idProduct == PRODUCT_ID) {
if(debug) {
printf("lvr_winusb with Vendor Id: %x and Product Id: %x found.\n", VENDOR_ID, PRODUCT_ID);
}
if ((s = libusb_open(devs[i], &handles[numdev])) < 0) {
fprintf(stderr, "Could not open USB device: %d\n", s);
continue;
}
numdev++;
}
}
libusb_free_device_list(devs, 1);
return numdev;
}
int setup_libusb_access(libusb_device_handle **handles) {
int i,numdev;
libusb_init(&ctx);
if(debug) {
libusb_set_debug(ctx, 4); //LIBUSB_LOG_LEVEL_DEBUG
} else {
libusb_set_debug(ctx, 0); //LIBUSB_LOG_LEVEL_NONE
}
if((numdev = find_lvr_winusb(handles)) < 1) {
fprintf(stderr, "Couldn't find the USB device, Exiting: %d\n", numdev);
return -1;
}
for (i = 0; i < numdev; i++) {
usb_detach(handles[i], INTERFACE1);
usb_detach(handles[i], INTERFACE2);
if (libusb_set_configuration(handles[i], 0x01) < 0) {
fprintf(stderr, "Could not set configuration 1\n");
return -1;
}
// Microdia tiene 2 interfaces
int s;
if ((s = libusb_claim_interface(handles[i], INTERFACE1)) < 0) {
fprintf(stderr, "Could not claim interface. Error:%d\n", s);
return -1;
}
if ((s = libusb_claim_interface(handles[i], INTERFACE2)) < 0) {
fprintf(stderr, "Could not claim interface. Error:%d\n", s);
return -1;
}
}
return numdev;
}
void ini_control_transfer(libusb_device_handle *dev) {
int r,i;
char question[] = { 0x01,0x01 };
r = libusb_control_transfer(dev, 0x21, 0x09, 0x0201, 0x00, (unsigned char *) question, 2, timeout);
if(r < 0) {
perror("USB control write"); bad("USB write failed");
}
if(debug) {
for (i=0;i<reqIntLen; i++) printf("%02x ",question[i] & 0xFF);
printf("\n");
}
}
void control_transfer(libusb_device_handle *dev, const char *pquestion) {
int r,i;
char question[reqIntLen];
memcpy(question, pquestion, sizeof question);
r = libusb_control_transfer(dev, 0x21, 0x09, 0x0200, 0x01, (unsigned char *) question, reqIntLen, timeout);
if(r < 0) {
perror("USB control write"); bad("USB write failed");
}
if(debug) {
for (i=0;i<reqIntLen; i++) printf("%02x ",question[i] & 0xFF);
printf("\n");
}
}
void interrupt_read(libusb_device_handle *dev) {
int r,s,i;
unsigned char answer[reqIntLen];
bzero(answer, reqIntLen);
s = libusb_interrupt_transfer(dev, endpoint_Int_in, answer, reqIntLen, &r, timeout);
if(r != reqIntLen) {
fprintf(stderr, "USB read failed: %d\n", s);
perror("USB interrupt read"); bad("USB read failed");
}
if(debug) {
for (i=0;i<reqIntLen; i++) printf("%02x ",answer[i] & 0xFF);
printf("\n");
}
}
void interrupt_read_temperature(libusb_device_handle *dev, float *tempInC, float *tempExC) {
int r,s,i, temperature;
unsigned char answer[reqIntLen];
bzero(answer, reqIntLen);
s = libusb_interrupt_transfer(dev, endpoint_Int_in, answer, reqIntLen, &r, timeout);
if(r != reqIntLen) {
fprintf(stderr, "USB read failed: %d\n", s);
perror("USB interrupt read"); bad("USB read failed");
}
if(debug) {
for (i=0;i<reqIntLen; i++) printf("%02x ",answer[i] & 0xFF);
printf("\n");
}
temperature = (answer[3] & 0xFF) + ((signed char)answer[2] << 8);
temperature += calibration;
*tempInC = temperature * (125.0 / 32000.0);
temperature = (answer[5] & 0xFF) + ((signed char)answer[4] << 8);
temperature += calibration;
*tempExC = temperature * (125.0 / 32000.0);
}
void ex_program(int sig) {
bsalir=1;
(void) signal(SIGINT, SIG_DFL);
}
int main( int argc, char **argv) {
libusb_device_handle **handles;
int numdev,i;
float tempInC;
float tempExC;
int c;
struct tm *local;
time_t t;
while ((c = getopt (argc, argv, "mfcvhl::a:")) != -1)
switch (c)
{
case 'v':
debug = 1;
break;
case 'c':
formato=1; //Celsius
break;
case 'f':
formato=2; //Fahrenheit
break;
case 'm':
mrtg=1;
break;
case 'l':
if (optarg!=NULL){
if (!sscanf(optarg,"%i",&seconds)==1) {
fprintf (stderr, "Error: '%s' is not numeric.\n", optarg);
exit(EXIT_FAILURE);
} else {
bsalir = 0;
break;
}
} else {
bsalir = 0;
seconds = 5;
break;
}
case 'a':
if (!sscanf(optarg,"%i",&calibration)==1) {
fprintf (stderr, "Error: '%s' is not numeric.\n", optarg);
exit(EXIT_FAILURE);
} else {
break;
}
case '?':
case 'h':
printf("pcsensor version %s\n",VERSION);
printf(" Available options:\n");
printf(" -h help\n");
printf(" -v verbose\n");
printf(" -l[n] loop every 'n' seconds, default value is 5s\n");
printf(" -c output only in Celsius\n");
printf(" -f output only in Fahrenheit\n");
printf(" -a[n] increase or decrease temperature in 'n' degrees for device calibration\n");
printf(" -m output for mrtg integration\n");
exit(EXIT_FAILURE);
default:
if (isprint (optopt))
fprintf (stderr, "Unknown option `-%c'.\n", optopt);
else
fprintf (stderr, "Unknown option character `\\x%x'.\n", optopt);
exit(EXIT_FAILURE);
}
if (optind < argc) {
fprintf(stderr, "Non-option ARGV-elements, try -h for help.\n");
exit(EXIT_FAILURE);
}
handles = calloc(MAX_DEV, sizeof(libusb_device_handle*));
if ((numdev = setup_libusb_access(handles)) < 1) {
exit(EXIT_FAILURE);
}
(void) signal(SIGINT, ex_program);
for (i = 0; i < numdev; i++) {
ini_control_transfer(handles[i]);
control_transfer(handles[i], uTemperature);
interrupt_read(handles[i]);
control_transfer(handles[i], uIni1);
interrupt_read(handles[i]);
control_transfer(handles[i], uIni2);
interrupt_read(handles[i]);
interrupt_read(handles[i]);
}
do {
for (i = 0; i < numdev; i++) {
control_transfer(handles[i], uTemperature);
interrupt_read_temperature(handles[i], &tempInC, &tempExC);
t = time(NULL);
local = localtime(&t);
if (mrtg) {
if (formato==2) {
printf("%.2f\n", (9.0 / 5.0 * tempInC + 32.0));
printf("%.2f\n", (9.0 / 5.0 * tempExC + 32.0));
} else {
printf("%.2f\n", tempInC);
printf("%.2f\n", tempExC);
}
printf("%02d:%02d\n",
local->tm_hour,
local->tm_min);
printf("pcsensor:%d\n", i);
} else {
printf("%04d/%02d/%02d %02d:%02d:%02d\n",
local->tm_year +1900,
local->tm_mon + 1,
local->tm_mday,
local->tm_hour,
local->tm_min,
local->tm_sec);
if (formato==2) {
printf("Temperature (%d:internal) %.2fF\n", i, (9.0 / 5.0 * tempInC + 32.0));
printf("Temperature (%d:external) %.2fF\n", i, (9.0 / 5.0 * tempExC + 32.0));
} else if (formato==1) {
printf("Temperature (%d:internal) %.2fC\n", i, tempInC);
printf("Temperature (%d:external) %.2fC\n", i, tempExC);
} else {
printf("Temperature (%d:internal) %.2fF %.2fC\n", i, (9.0 / 5.0 * tempInC + 32.0), tempInC);
printf("Temperature (%d:external) %.2fF %.2fC\n", i, (9.0 / 5.0 * tempExC + 32.0), tempExC);
}
}
if (!bsalir)
sleep(seconds);
}
} while (!bsalir);
for (i = 0; i < numdev; i++) {
libusb_release_interface(handles[i], INTERFACE1);
libusb_release_interface(handles[i], INTERFACE2);
libusb_close(handles[i]);
}
return 0;
}
Reference in a new issue View git blame Copy permalink