402 lines
9.1 KiB
C
402 lines
9.1 KiB
C
#include <stdint.h>
|
|
#include <stdio.h>
|
|
#include "usb.h"
|
|
#include "gamepads.h"
|
|
#include "usbpad.h"
|
|
#include "mappings.h"
|
|
|
|
#define REPORT_ID 1
|
|
#define REPORT_SIZE 15
|
|
|
|
// Output Report IDs for various functions
|
|
#define REPORT_SET_EFFECT 0x01
|
|
#define REPORT_SET_STATUS 0x02
|
|
#define REPORT_SET_PERIODIC 0x04
|
|
#define REPORT_SET_CONSTANT_FORCE 0x05
|
|
#define REPORT_EFFECT_OPERATION 0x0A
|
|
#define REPORT_EFFECT_BLOCK_IDX 0x0B
|
|
#define REPORT_DISABLE_ACTUATORS 0x0C
|
|
#define REPORT_PID_POOL 0x0D
|
|
|
|
// Feature reports
|
|
#define REPORT_CREATE_EFFECT 0x09
|
|
|
|
// For the 'Usage Effect Operation' report
|
|
#define EFFECT_OP_START 1
|
|
#define EFFECT_OP_START_SOLO 2
|
|
#define EFFECT_OP_STOP 3
|
|
|
|
// Feature report
|
|
#define PID_SIMULTANEOUS_MAX 3
|
|
#define PID_BLOCK_LOAD_REPORT 2
|
|
|
|
|
|
|
|
|
|
static volatile unsigned char gamepad_vibrate = 0; // output
|
|
static unsigned char vibration_on = 0;
|
|
static unsigned char constant_force = 0;
|
|
static unsigned char magnitude = 0;
|
|
|
|
static unsigned char _FFB_effect_index;
|
|
#define LOOP_MAX 0xFFFF
|
|
static unsigned int _loop_count;
|
|
|
|
static unsigned char gamepad_report0[32];
|
|
static unsigned char hid_report_data[32];
|
|
|
|
void usbpad_init()
|
|
{
|
|
}
|
|
|
|
int usbpad_getReportSize(void)
|
|
{
|
|
return REPORT_SIZE;
|
|
}
|
|
|
|
static int16_t minmax(int16_t input, int16_t min, int16_t max)
|
|
{
|
|
if (input > max)
|
|
return max;
|
|
if (input < min)
|
|
return min;
|
|
|
|
return input;
|
|
}
|
|
|
|
static void btnsToReport(unsigned short buttons, unsigned char dstbuf[2])
|
|
{
|
|
dstbuf[0] = buttons & 0xff;
|
|
dstbuf[1] = buttons >> 8;
|
|
}
|
|
|
|
static void buildIdleReport(unsigned char dstbuf[REPORT_SIZE])
|
|
{
|
|
int i;
|
|
|
|
dstbuf[0] = REPORT_ID;
|
|
|
|
/* Inactive and centered axis */
|
|
for (i=0; i<6; i++) {
|
|
dstbuf[1+i*2] = 0x80;
|
|
dstbuf[2+i*2] = 0x3e;
|
|
}
|
|
|
|
/* Inactive buttons */
|
|
dstbuf[13] = 0;
|
|
dstbuf[14] = 0;
|
|
}
|
|
|
|
static void buildReportFromGC(const gc_pad_data *gc_data, unsigned char dstbuf[REPORT_SIZE])
|
|
{
|
|
int16_t xval,yval,cxval,cyval,ltrig,rtrig;
|
|
uint16_t buttons;
|
|
|
|
/* Force official range */
|
|
xval = minmax(gc_data->x, -100, 100);
|
|
yval = minmax(gc_data->y, -100, 100);
|
|
cxval = minmax(gc_data->cx, -100, 100);
|
|
cyval = minmax(gc_data->cy, -100, 100);
|
|
ltrig = gc_data->lt;
|
|
rtrig = gc_data->rt;
|
|
|
|
/* Scale -100 ... + 1000 to -16000 ... +16000 */
|
|
xval *= 160;
|
|
yval *= -160;
|
|
// TODO : Is C-stick different?
|
|
cxval *= 160;
|
|
cyval *= -160;
|
|
|
|
/* Scane 0...255 to 0...16000 */
|
|
ltrig *= 63;
|
|
if (ltrig > 16000) ltrig=16000;
|
|
rtrig *= 63;
|
|
if (rtrig > 16000) rtrig=16000;
|
|
|
|
/* Unsign for HID report */
|
|
xval += 16000;
|
|
yval += 16000;
|
|
cxval += 16000;
|
|
cyval += 16000;
|
|
ltrig += 16000;
|
|
rtrig += 16000;
|
|
|
|
dstbuf[1] = ((uint8_t*)&xval)[0];
|
|
dstbuf[2] = ((uint8_t*)&xval)[1];
|
|
dstbuf[3] = ((uint8_t*)&yval)[0];
|
|
dstbuf[4] = ((uint8_t*)&yval)[1];
|
|
|
|
dstbuf[5] = ((uint8_t*)&cxval)[0];
|
|
dstbuf[6] = ((uint8_t*)&cxval)[1];
|
|
dstbuf[7] = ((uint8_t*)&cyval)[0];
|
|
dstbuf[8] = ((uint8_t*)&cyval)[1];
|
|
|
|
dstbuf[9] = ((uint8_t*)<rig)[0];
|
|
dstbuf[10] = ((uint8_t*)<rig)[1];
|
|
|
|
dstbuf[11] = ((uint8_t*)&rtrig)[0];
|
|
dstbuf[12] = ((uint8_t*)&rtrig)[1];
|
|
|
|
buttons = mappings_do(MAPPING_GAMECUBE_DEFAULT, gc_data->buttons);
|
|
btnsToReport(buttons, dstbuf+13);
|
|
}
|
|
|
|
static void buildReportFromN64(const n64_pad_data *n64_data, unsigned char dstbuf[REPORT_SIZE])
|
|
{
|
|
int16_t xval, yval;
|
|
uint16_t buttons;
|
|
|
|
/* Force official range */
|
|
xval = minmax(n64_data->x, -80, 80);
|
|
yval = minmax(n64_data->y, -80, 80);
|
|
|
|
/* Scale -80 ... +80 to -16000 ... +16000 */
|
|
xval *= 200;
|
|
yval *= 200;
|
|
yval = -yval;
|
|
|
|
/* Unsign for HID report */
|
|
xval += 16000;
|
|
yval += 16000;
|
|
|
|
dstbuf[1] = ((uint8_t*)&xval)[0];
|
|
dstbuf[2] = ((uint8_t*)&xval)[1];
|
|
dstbuf[3] = ((uint8_t*)&yval)[0];
|
|
dstbuf[4] = ((uint8_t*)&yval)[1];
|
|
|
|
buttons = mappings_do(MAPPING_N64_DEFAULT, n64_data->buttons);
|
|
btnsToReport(buttons, dstbuf+13);
|
|
}
|
|
|
|
void usbpad_update(const gamepad_data *pad_data)
|
|
{
|
|
/* Always start with an idle report. Specific report builders can just
|
|
* simply ignore unused parts */
|
|
buildIdleReport(gamepad_report0);
|
|
|
|
if (pad_data)
|
|
{
|
|
switch (pad_data->pad_type)
|
|
{
|
|
case PAD_TYPE_N64:
|
|
buildReportFromN64(&pad_data->n64, gamepad_report0);
|
|
break;
|
|
|
|
case PAD_TYPE_GAMECUBE:
|
|
buildReportFromGC(&pad_data->gc, gamepad_report0);
|
|
break;
|
|
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
char usbpad_mustVibrate(void)
|
|
{
|
|
if (!vibration_on) {
|
|
gamepad_vibrate = 0;
|
|
} else {
|
|
if (constant_force > 0x7f) {
|
|
gamepad_vibrate = 1;
|
|
}
|
|
if (magnitude > 0x7f) {
|
|
gamepad_vibrate = 1;
|
|
}
|
|
}
|
|
|
|
return gamepad_vibrate;
|
|
}
|
|
|
|
unsigned char *usbpad_getReportBuffer(void)
|
|
{
|
|
return gamepad_report0;
|
|
}
|
|
|
|
uint16_t usbpad_hid_get_report(struct usb_request *rq, const uint8_t **dat)
|
|
{
|
|
uint8_t report_id = (rq->wValue & 0xff);
|
|
|
|
// USB HID 1.11 section 7.2.1 Get_Report
|
|
// wValue high byte : report type
|
|
// wValue low byte : report id
|
|
// wIndex Interface
|
|
switch (rq->wValue >> 8)
|
|
{
|
|
case HID_REPORT_TYPE_INPUT:
|
|
{
|
|
if (report_id == 1) { // Joystick
|
|
// report_id = rq->wValue & 0xff
|
|
// interface = rq->wIndex
|
|
*dat = gamepad_report0;
|
|
printf_P(PSTR("Get joy report\r\n"));
|
|
return 9;
|
|
} else if (report_id == 2) { // 2 : ES playing
|
|
hid_report_data[0] = report_id;
|
|
hid_report_data[1] = 0;
|
|
hid_report_data[2] = _FFB_effect_index;
|
|
printf_P(PSTR("ES playing\r\n"));
|
|
*dat = hid_report_data;
|
|
return 3;
|
|
} else {
|
|
printf_P(PSTR("Get input report %d ??\r\n"), rq->wValue & 0xff);
|
|
}
|
|
}
|
|
break;
|
|
|
|
case HID_REPORT_TYPE_FEATURE:
|
|
if (report_id == PID_BLOCK_LOAD_REPORT) {
|
|
hid_report_data[0] = report_id;
|
|
hid_report_data[1] = 0x1; // Effect block index
|
|
hid_report_data[2] = 0x1; // (1: success, 2: oom, 3: load error)
|
|
hid_report_data[3] = 10;
|
|
hid_report_data[4] = 10;
|
|
printf_P(PSTR("block load\r\n"));
|
|
*dat = hid_report_data;
|
|
return 5;
|
|
}
|
|
else if (report_id == PID_SIMULTANEOUS_MAX) {
|
|
hid_report_data[0] = report_id;
|
|
// ROM Effect Block count
|
|
hid_report_data[1] = 0x1;
|
|
hid_report_data[2] = 0x1;
|
|
// PID pool move report?
|
|
hid_report_data[3] = 0xff;
|
|
hid_report_data[4] = 1;
|
|
printf_P(PSTR("simultaneous max\r\n"));
|
|
*dat = hid_report_data;
|
|
return 5;
|
|
}
|
|
else if (report_id == REPORT_CREATE_EFFECT) {
|
|
hid_report_data[0] = report_id;
|
|
hid_report_data[1] = 1;
|
|
printf_P(PSTR("create effect\r\n"));
|
|
*dat = hid_report_data;
|
|
return 2;
|
|
} else {
|
|
printf_P(PSTR("Unknown feature %d\r\n"), rq->wValue & 0xff);
|
|
}
|
|
break;
|
|
}
|
|
|
|
printf_P(PSTR("Unhandled hid get report type=0x%02x, rq=0x%02x, wVal=0x%04x, wLen=0x%04x\r\n"), rq->bmRequestType, rq->bRequest, rq->wValue, rq->wLength);
|
|
return 0;
|
|
}
|
|
|
|
uint8_t usbpad_hid_set_report(const struct usb_request *rq, const uint8_t *data, uint16_t len)
|
|
{
|
|
if (len < 1) {
|
|
printf_P(PSTR("shrt\n"));
|
|
return -1;
|
|
}
|
|
|
|
if ((rq->wValue >> 8) == HID_REPORT_TYPE_OUTPUT) {
|
|
|
|
switch(data[0])
|
|
{
|
|
case REPORT_SET_STATUS:
|
|
printf_P(PSTR("eff. set stat 0x%02x 0x%02x\r\n"),data[1],data[2]);
|
|
break;
|
|
case REPORT_EFFECT_BLOCK_IDX:
|
|
printf_P(PSTR("eff. blk. idx %d\r\n"), data[1]);
|
|
break;
|
|
case REPORT_DISABLE_ACTUATORS:
|
|
printf_P(PSTR("disable actuators\r\n"));
|
|
break;
|
|
case REPORT_PID_POOL:
|
|
printf_P(PSTR("pid pool\r\n"));
|
|
break;
|
|
case REPORT_SET_EFFECT:
|
|
_FFB_effect_index = data[1];
|
|
printf_P(PSTR("set effect %d\n"), data[1]);
|
|
break;
|
|
case REPORT_SET_PERIODIC:
|
|
magnitude = data[2];
|
|
printf_P(PSTR("periodic mag: %d"), data[2]);
|
|
break;
|
|
case REPORT_SET_CONSTANT_FORCE:
|
|
if (data[1] == 1) {
|
|
constant_force = data[2];
|
|
//decideVibration();
|
|
printf_P(PSTR("Constant force"));
|
|
}
|
|
break;
|
|
case REPORT_EFFECT_OPERATION:
|
|
if (len != 4)
|
|
return -1;
|
|
/* Byte 0 : report ID
|
|
* Byte 1 : bit 7=rom flag, bits 6-0=effect block index
|
|
* Byte 2 : Effect operation
|
|
* Byte 3 : Loop count */
|
|
_loop_count = data[3]<<3;
|
|
|
|
printf_P(PSTR("EFFECT OP: rom=%s, idx=0x%02x"), data[1] & 0x80 ? "Yes":"No", data[1] & 0x7F);
|
|
|
|
switch(data[1] & 0x7F) // Effect block index
|
|
{
|
|
case 1: // constant force
|
|
case 3: // square
|
|
case 4: // sine
|
|
switch (data[2]) // effect operation
|
|
{
|
|
case EFFECT_OP_START:
|
|
printf_P(PSTR("Start\r\n"));
|
|
vibration_on = 1;
|
|
// decideVibration();
|
|
break;
|
|
|
|
case EFFECT_OP_START_SOLO:
|
|
printf_P(PSTR("Start solo\r\n"));
|
|
vibration_on = 1;
|
|
// decideVibration();
|
|
break;
|
|
|
|
case EFFECT_OP_STOP:
|
|
printf_P(PSTR("Stop\r\n"));
|
|
vibration_on = 0;
|
|
// decideVibration();
|
|
break;
|
|
}
|
|
break;
|
|
|
|
// TODO : should probably drop these from the descriptor since they are
|
|
|
|
case 2: // ramp
|
|
case 5: // triangle
|
|
case 6: // sawtooth up
|
|
case 7: // sawtooth down
|
|
case 8: // spring
|
|
case 9: // damper
|
|
case 10: // inertia
|
|
case 11: // friction
|
|
case 12: // custom force data
|
|
printf_P(PSTR("Ununsed effect %d\n"), data[1] & 0x7F);
|
|
break;
|
|
}
|
|
break;
|
|
default:
|
|
printf_P(PSTR("Set output report 0x%02x\r\n"), data[0]);
|
|
}
|
|
}
|
|
else if ((rq->wValue >> 8) == HID_REPORT_TYPE_FEATURE) {
|
|
switch(data[0])
|
|
{
|
|
case REPORT_CREATE_EFFECT:
|
|
_FFB_effect_index = data[1];
|
|
printf_P(PSTR("create effect %d\n"), data[1]);
|
|
break;
|
|
|
|
default:
|
|
printf_P(PSTR("What?\n"));
|
|
}
|
|
}
|
|
else {
|
|
printf_P(PSTR("impossible\n"));
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
|
|
|
|
|