89 lines
2.1 KiB
C
89 lines
2.1 KiB
C
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <math.h>
|
|
#include <string.h>
|
|
|
|
#include <hidapi/hidapi.h>
|
|
|
|
#include "moza.h"
|
|
#include "../serialadapter.h"
|
|
#include "../../slog/slog.h"
|
|
|
|
#define MOZA_TIMEOUT 1000
|
|
#define MOZA_SERIAL_TEMPLATE {0x7e, 0x06, 0x41, 0x13, 0xfd, 0xde, 0x0, 0x0, 0x0, 0x0, 0x0}
|
|
#define MOZA_NUM_AVAILABLE_LEDS 10
|
|
#define MOZA_BLINKING_BIT 7
|
|
#define MOZA_MAGIC_VALUE 0x0d
|
|
#define BIT(nr) (1UL << (nr))
|
|
|
|
unsigned char moza_checksum(unsigned char *data)
|
|
{
|
|
unsigned char ret = MOZA_MAGIC_VALUE;
|
|
for (short i = 0; i < sizeof(data)/sizeof(data[0]); i++)
|
|
{
|
|
ret += data[i];
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
int moza_update(SerialDevice* serialdevice, unsigned short maxrpm, unsigned short rpm)
|
|
{
|
|
unsigned char bytes[] = MOZA_SERIAL_TEMPLATE;
|
|
int size = sizeof(bytes)/sizeof(bytes[0]);
|
|
|
|
float perct = (float)rpm/(float)maxrpm;
|
|
|
|
if (perct >= 0.8)
|
|
bytes[9] |= BIT(0);
|
|
|
|
if (perct >= 0.83)
|
|
bytes[9] |= BIT(1);
|
|
|
|
if (perct >= 0.86)
|
|
bytes[9] |= BIT(2);
|
|
|
|
if (perct >= 0.89)
|
|
bytes[9] |= BIT(3);
|
|
|
|
if (perct >= 0.91)
|
|
bytes[8] |= BIT(4);
|
|
|
|
if (perct >= 0.92)
|
|
bytes[8] |= BIT(5);
|
|
|
|
if (perct >= 0.93)
|
|
bytes[8] |= BIT(6);
|
|
|
|
if (perct >= 0.94)
|
|
bytes[8] |= BIT(7);
|
|
|
|
if (perct >= 0.96)
|
|
bytes[8] |= BIT(0);
|
|
|
|
if (perct >= 0.96)
|
|
bytes[8] |= BIT(1);
|
|
|
|
// blinking
|
|
if (perct >= 0.97)
|
|
bytes[9] |= BIT(MOZA_BLINKING_BIT);
|
|
|
|
bytes[10] = moza_checksum(bytes);
|
|
|
|
int result = 1;
|
|
if (serialdevice->port)
|
|
{
|
|
slogd("copying %i bytes to moza device", size);
|
|
slogt("writing bytes %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x from rpm %i maxrpm %i", bytes[0], bytes[1], bytes[2], bytes[3], bytes[4], bytes[5], bytes[6], bytes[7], bytes[8], bytes[9], bytes[10], rpm, maxrpm);
|
|
result = monocoque_serial_write(serialdevice->id, bytes, size, MOZA_TIMEOUT);
|
|
}
|
|
|
|
return result;
|
|
}
|
|
|
|
int moza_init(SerialDevice* serialdevice, const char* portdev)
|
|
{
|
|
serialdevice->id = monocoque_serial_open(serialdevice, portdev);
|
|
return serialdevice->id;
|
|
}
|