|
|
|
@ -54,28 +54,72 @@ namespace InputMapper
|
|
|
|
|
tdpad_right.init(pos_x, pos_y, pos_r, TouchDpad::DPAD_TYPE_SECTOR4);
|
|
|
|
|
tdpad_right.setDeadZoneInner(dead_zone_inner);
|
|
|
|
|
|
|
|
|
|
pos_x = (62.5 - 20.636) * ppmX;
|
|
|
|
|
pos_y = 20.636 * ppmY;
|
|
|
|
|
|
|
|
|
|
tdpad_left.init(pos_x, pos_y, pos_r, TouchDpad::DPAD_TYPE_SECTOR4);
|
|
|
|
|
tdpad_left.setDeadZoneInner(dead_zone_inner);
|
|
|
|
|
|
|
|
|
|
device.begin();
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
uint16_t dpad_map[][4] =
|
|
|
|
|
{
|
|
|
|
|
{
|
|
|
|
|
USB_Device::DPAD_UP,
|
|
|
|
|
USB_Device::DPAD_DOWN,
|
|
|
|
|
USB_Device::DPAD_LEFT,
|
|
|
|
|
USB_Device::DPAD_RIGHT,
|
|
|
|
|
},
|
|
|
|
|
{
|
|
|
|
|
USB_Device::FACE_Y,
|
|
|
|
|
USB_Device::FACE_A,
|
|
|
|
|
USB_Device::FACE_X,
|
|
|
|
|
USB_Device::FACE_B,
|
|
|
|
|
},
|
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
uint16_t mapDpad(uint8_t dpad, uint8_t direction)
|
|
|
|
|
{
|
|
|
|
|
uint16_t button = 0;
|
|
|
|
|
|
|
|
|
|
for (uint8_t i = 0; i < 4; ++i)
|
|
|
|
|
{
|
|
|
|
|
if (direction & (1 << i))
|
|
|
|
|
{
|
|
|
|
|
button |= dpad_map[dpad][i];
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
return button;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void mapTrackpad(uint8_t id, uint8_t fid, int32_t x, int32_t y)
|
|
|
|
|
{
|
|
|
|
|
for (uint8_t c = 0; c < num_controls; ++c)
|
|
|
|
|
{
|
|
|
|
|
int8_t res = tcontrols[id][c]->touch(fid, x, y);
|
|
|
|
|
|
|
|
|
|
int res;
|
|
|
|
|
|
|
|
|
|
switch(tcontrols[id][c]->getControlType())
|
|
|
|
|
{
|
|
|
|
|
case TouchControl::CT_NONE:
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
|
|
case TouchControl::CT_JOYSTICK:
|
|
|
|
|
//Serial.printf("%i, %i\n", ((TouchJoystick*)tcontrols[c])->getX(), ((TouchJoystick*)tcontrols[c])->getY());
|
|
|
|
|
//device.joystick_left(((TouchJoystick*)tcontrols[c])->getX(), ((TouchJoystick*)tcontrols[c])->getY());
|
|
|
|
|
res = tcontrols[id][c]->touch(fid, x, y);
|
|
|
|
|
device.joystick(id, ((TouchJoystick*)tcontrols[id][c])->getX(), ((TouchJoystick*)tcontrols[id][c])->getY());
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
|
|
case TouchControl::CT_DPAD:
|
|
|
|
|
device.dpad(((TouchDpad*)tcontrols[id][c])->getButton());
|
|
|
|
|
{
|
|
|
|
|
uint16_t prev_button = mapDpad(id, ((TouchDpad*)tcontrols[id][c])->getButton());
|
|
|
|
|
device.button(prev_button, 0);
|
|
|
|
|
|
|
|
|
|
res = tcontrols[id][c]->touch(fid, x, y);
|
|
|
|
|
|
|
|
|
|
uint16_t button = mapDpad(id, ((TouchDpad*)tcontrols[id][c])->getButton());
|
|
|
|
|
device.button(button, button);
|
|
|
|
|
}
|
|
|
|
|
break;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
@ -87,34 +131,50 @@ namespace InputMapper
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void mapTriggers(uint32_t values[2])
|
|
|
|
|
void mapTriggers(uint32_t value[2])
|
|
|
|
|
{
|
|
|
|
|
uint8_t mapped_values[2];
|
|
|
|
|
static const uint32_t max = 70;
|
|
|
|
|
static const uint32_t min = 2;
|
|
|
|
|
|
|
|
|
|
mapped_values[0] = 0;
|
|
|
|
|
|
|
|
|
|
// 160 - 540
|
|
|
|
|
if (values[1] < 160)
|
|
|
|
|
{
|
|
|
|
|
mapped_values[1] = 0;
|
|
|
|
|
}
|
|
|
|
|
else if(values[1] >= 540)
|
|
|
|
|
uint8_t mapped_value[2];
|
|
|
|
|
|
|
|
|
|
for (uint8_t i = 0; i < 2; ++i)
|
|
|
|
|
{
|
|
|
|
|
mapped_values[1] = 0xFF;
|
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
|
|
|
|
mapped_values[1] = (values[1] - 160) * 0xFF / (540 - 160);
|
|
|
|
|
if (value[i] < min)
|
|
|
|
|
{
|
|
|
|
|
mapped_value[i] = 0;
|
|
|
|
|
}
|
|
|
|
|
else if (value[i] > max)
|
|
|
|
|
{
|
|
|
|
|
mapped_value[i] = 255;
|
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
|
|
|
|
mapped_value[i] = (value[i] - min) * 255 / (max - min);
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
device.triggers(mapped_values);
|
|
|
|
|
device.triggers(mapped_value);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void mapButtons(uint16_t buttons)
|
|
|
|
|
uint16_t button_map[] =
|
|
|
|
|
{
|
|
|
|
|
uint16_t mappedButtons = buttons >> 4;
|
|
|
|
|
USB_Device::START,
|
|
|
|
|
USB_Device::SELECT,
|
|
|
|
|
USB_Device::JOYSTICK_LEFT,
|
|
|
|
|
USB_Device::JOYSTICK_RIGHT,
|
|
|
|
|
USB_Device::BUMPER_LEFT,
|
|
|
|
|
USB_Device::BUMPER_RIGHT,
|
|
|
|
|
USB_Device::HOME,
|
|
|
|
|
USB_Device::FACE_A,
|
|
|
|
|
USB_Device::FACE_B,
|
|
|
|
|
USB_Device::FACE_X,
|
|
|
|
|
USB_Device::FACE_Y,
|
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
device.buttons(mappedButtons);
|
|
|
|
|
void mapButton(HardwareButtons button, bool value)
|
|
|
|
|
{
|
|
|
|
|
device.button(button_map[button], value? button_map[button] : 0);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void sendReport()
|
|
|
|
|