djsundog/circuitpython
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Read one bit per system clock tick in GamePadShift

Browse Source
This commit is contained in:
Radomir Dopieralski 2019-04-10 22:44:50 +02:00
parent 6ff4e0ecb0
commit a7925930fa
4 changed files with 53 additions and 33 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
shared-bindings/gamepad/GamePad.c
View File

@ -151,7 +151,7 @@ STATIC mp_obj_t gamepadshift_make_new(const mp_obj_type_t *type, size_t n_args,
if (!MP_STATE_VM(gamepad_singleton)) {
gamepad_obj_t* gamepad_singleton = m_new_obj(gamepad_obj_t);
gamepad_singleton->base.type = &gamepad_type;
gamepad_singleton->base.type = &gamepadshift_type;
MP_STATE_VM(gamepad_singleton) = gc_make_long_lived(gamepad_singleton);
}
gamepad_init_shift(data_pin, clock_pin, latch_pin);

2
shared-module/gamepad/GamePad.c
View File

@ -56,7 +56,6 @@ void gamepad_init_pins(size_t n_pins, const mp_obj_t* pins) {
}
gamepad_singleton->pins[i] = pin;
}
gamepad_singleton->last = 0;
gamepad_singleton->kind = GAMEPAD_KIND_PINS;
}
@ -74,6 +73,5 @@ void gamepad_init_shift(digitalio_digitalinout_obj_t *data_pin,
common_hal_digitalio_digitalinout_switch_to_output(clock_pin, 1, DRIVE_MODE_PUSH_PULL);
gamepad_singleton->pins[2] = latch_pin;
gamepad_singleton->last = 0;
gamepad_singleton->kind = GAMEPAD_KIND_PINS;
}

1
shared-module/gamepad/GamePad.h
View File

@ -34,7 +34,6 @@
typedef struct {
mp_obj_base_t base;
digitalio_digitalinout_obj_t* pins[8];
volatile uint8_t last;
volatile uint8_t pressed;
uint8_t pulls;
uint8_t kind;

81
shared-module/gamepad/__init__.c
View File

@ -33,46 +33,69 @@
#include "shared-bindings/digitalio/DigitalInOut.h"
void pressed_pins(gamepad_obj_t *self) {
static uint8_t last = 0;
uint8_t current = 0;
uint8_t bit = 1;
for (int i = 0; i < 8; ++i) {
digitalio_digitalinout_obj_t* pin = self->pins[i];
if (!pin) {
break;
}
if (common_hal_digitalio_digitalinout_get_value(pin)) {
current |= bit;
}
bit <<= 1;
}
current ^= self->pulls;
self->pressed |= last & current;
last = current;
}
void pressed_shift(gamepad_obj_t *self) {
static volatile uint8_t i = 8;
static volatile uint8_t clock = 0;
digitalio_digitalinout_obj_t* data_pin = self->pins[0];
digitalio_digitalinout_obj_t* clock_pin = self->pins[1];
digitalio_digitalinout_obj_t* latch_pin = self->pins[2];
if (clock == 0) {
common_hal_digitalio_digitalinout_set_value(clock_pin, 1);
clock = 1;
return;
}
if (i == 8) {
common_hal_digitalio_digitalinout_set_value(latch_pin, 0);
i = 9;
} else if (i == 9) {
common_hal_digitalio_digitalinout_set_value(latch_pin, 1);
i = 0;
} else {
if (common_hal_digitalio_digitalinout_get_value(data_pin)) {
self->pressed |= (1 << i);
}
i += 1;
}
common_hal_digitalio_digitalinout_set_value(clock_pin, 0);
clock = 0;
}
void gamepad_tick(void) {
gamepad_obj_t* gamepad_singleton = MP_STATE_VM(gamepad_singleton);
if (!gamepad_singleton) {
return;
}
uint8_t gamepad_current = 0;
uint8_t bit = 1;
switch (gamepad_singleton->kind) {
case GAMEPAD_KIND_PINS:
for (int i = 0; i < 8; ++i) {
digitalio_digitalinout_obj_t* pin = gamepad_singleton->pins[i];
if (!pin) {
break;
}
if (common_hal_digitalio_digitalinout_get_value(pin)) {
gamepad_current |= bit;
}
bit <<= 1;
}
gamepad_current ^= gamepad_singleton->pulls;
pressed_pins(gamepad_singleton);
break;
case GAMEPAD_KIND_SHIFT:
bit = 1;
digitalio_digitalinout_obj_t* data_pin = gamepad_singleton->pins[0];
digitalio_digitalinout_obj_t* clock_pin = gamepad_singleton->pins[1];
digitalio_digitalinout_obj_t* latch_pin = gamepad_singleton->pins[2];
common_hal_digitalio_digitalinout_set_value(latch_pin, 0);
for (int i = 0; i < 8; ++i) {
common_hal_digitalio_digitalinout_set_value(clock_pin, 1);
if (common_hal_digitalio_digitalinout_get_value(data_pin)) {
gamepad_current |= bit;
}
bit <<= 1;
common_hal_digitalio_digitalinout_set_value(clock_pin, 0);
}
common_hal_digitalio_digitalinout_set_value(latch_pin, 1);
pressed_shift(gamepad_singleton);
break;
}
gamepad_singleton->pressed |= gamepad_singleton->last & gamepad_current;
gamepad_singleton->last = gamepad_current;
}
void gamepad_reset(void) {