Broadcast button presses to CAN
This commit is contained in:
parent
7065cb455a
commit
30607718ac
|
@ -9,8 +9,8 @@ extern "C" {
|
||||||
|
|
||||||
#define NUM_BUTTONS 6
|
#define NUM_BUTTONS 6
|
||||||
#define NUM_ENCS 2
|
#define NUM_ENCS 2
|
||||||
#define BUTTON_MIN_PRESS_TIME 50 // ms
|
#define BUTTON_MIN_INTERVAL 50 // ms
|
||||||
#define ENC_MAX_PHASE 50 // ms
|
#define ENC_MAX_PHASE 50 // ms
|
||||||
|
|
||||||
typedef enum { UMK_BTN_RELEASED, UMK_ENC_CW, UMK_ENC_CCW } ButtonMessageKind;
|
typedef enum { UMK_BTN_RELEASED, UMK_ENC_CW, UMK_ENC_CCW } ButtonMessageKind;
|
||||||
|
|
||||||
|
|
|
@ -5,6 +5,8 @@
|
||||||
#include "stw_defines.h"
|
#include "stw_defines.h"
|
||||||
#include "tx_port.h"
|
#include "tx_port.h"
|
||||||
|
|
||||||
|
#include "stm32h7xx_hal.h"
|
||||||
|
|
||||||
#ifdef __cplusplus
|
#ifdef __cplusplus
|
||||||
extern "C" {
|
extern "C" {
|
||||||
#endif
|
#endif
|
||||||
|
@ -108,6 +110,7 @@ void vehicle_thread_entry(ULONG hfdcan_addr);
|
||||||
void vehicle_select_mission(Mission mission);
|
void vehicle_select_mission(Mission mission);
|
||||||
|
|
||||||
void vehicle_broadcast_param(ParamType param, int32_t value);
|
void vehicle_broadcast_param(ParamType param, int32_t value);
|
||||||
|
void vehicle_broadcast_buttons(GPIO_PinState *button_states);
|
||||||
|
|
||||||
#ifdef __cplusplus
|
#ifdef __cplusplus
|
||||||
}
|
}
|
||||||
|
|
|
@ -7,6 +7,7 @@
|
||||||
|
|
||||||
#include "hx8357d.h"
|
#include "hx8357d.h"
|
||||||
#include "main.h"
|
#include "main.h"
|
||||||
|
#include "vehicle.h"
|
||||||
#include <stdint.h>
|
#include <stdint.h>
|
||||||
|
|
||||||
void ui_thread_entry(ULONG _) {
|
void ui_thread_entry(ULONG _) {
|
||||||
|
@ -16,22 +17,24 @@ void ui_thread_entry(ULONG _) {
|
||||||
uint16_t button_pins[NUM_BUTTONS] = {BTN1_Pin, BTN2_Pin, BTN3_Pin,
|
uint16_t button_pins[NUM_BUTTONS] = {BTN1_Pin, BTN2_Pin, BTN3_Pin,
|
||||||
BTN4_Pin, BTN5_Pin, BTN6_Pin};
|
BTN4_Pin, BTN5_Pin, BTN6_Pin};
|
||||||
GPIO_PinState button_states[NUM_BUTTONS] = {GPIO_PIN_RESET};
|
GPIO_PinState button_states[NUM_BUTTONS] = {GPIO_PIN_RESET};
|
||||||
uint32_t button_change_times[NUM_BUTTONS] = {HAL_GetTick()};
|
uint32_t button_press_times[NUM_BUTTONS] = {HAL_GetTick()};
|
||||||
|
|
||||||
while (1) {
|
while (1) {
|
||||||
for (int i = 0; i < NUM_BUTTONS; i++) {
|
for (int i = 0; i < NUM_BUTTONS; i++) {
|
||||||
GPIO_PinState state = HAL_GPIO_ReadPin(button_ports[i], button_pins[i]);
|
GPIO_PinState state = HAL_GPIO_ReadPin(button_ports[i], button_pins[i]);
|
||||||
if (state != button_states[i]) {
|
if (state != button_states[i]) {
|
||||||
uint32_t now = HAL_GetTick();
|
uint32_t now = HAL_GetTick();
|
||||||
if (state == GPIO_PIN_RESET && now - button_change_times[i]) {
|
if (state == GPIO_PIN_SET &&
|
||||||
// Button release event!
|
now - button_press_times[i] >= BUTTON_MIN_INTERVAL) {
|
||||||
|
// Button press event!
|
||||||
|
button_press_times[i] = now;
|
||||||
ButtonMessage msg = {.kind = UMK_BTN_RELEASED, .number = i};
|
ButtonMessage msg = {.kind = UMK_BTN_RELEASED, .number = i};
|
||||||
tx_queue_send(&gui_button_queue, &msg, TX_NO_WAIT);
|
tx_queue_send(&gui_button_queue, &msg, TX_NO_WAIT);
|
||||||
}
|
}
|
||||||
button_change_times[i] = now;
|
|
||||||
button_states[i] = state;
|
button_states[i] = state;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
vehicle_broadcast_buttons(button_states);
|
||||||
// Release so other threads can get scheduled
|
// Release so other threads can get scheduled
|
||||||
tx_thread_sleep(1);
|
tx_thread_sleep(1);
|
||||||
}
|
}
|
||||||
|
|
|
@ -13,6 +13,7 @@
|
||||||
|
|
||||||
#define CAN_ID_AMS_STATUS 0xA
|
#define CAN_ID_AMS_STATUS 0xA
|
||||||
#define CAN_ID_MISSION_SELECTED 0x400
|
#define CAN_ID_MISSION_SELECTED 0x400
|
||||||
|
#define CAN_ID_STW_BUTTONS 0x401
|
||||||
#define CAN_ID_STW_PARAM_SET 0x402
|
#define CAN_ID_STW_PARAM_SET 0x402
|
||||||
#define CAN_ID_AS_MISSION_FB 0x410
|
#define CAN_ID_AS_MISSION_FB 0x410
|
||||||
#define CAN_ID_STW_STATUS 0x412
|
#define CAN_ID_STW_STATUS 0x412
|
||||||
|
@ -51,6 +52,12 @@ void vehicle_broadcast_param(ParamType param, int32_t value) {
|
||||||
ftcan_transmit(CAN_ID_STW_PARAM_SET, data, 5);
|
ftcan_transmit(CAN_ID_STW_PARAM_SET, data, 5);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
void vehicle_broadcast_buttons(GPIO_PinState *button_states) {
|
||||||
|
uint8_t data = (button_states[0] << 2) | (button_states[1] << 0) |
|
||||||
|
(button_states[2] << 1) | (button_states[3] << 3);
|
||||||
|
ftcan_transmit(CAN_ID_STW_BUTTONS, &data, 1);
|
||||||
|
}
|
||||||
|
|
||||||
void ftcan_msg_received_cb(uint16_t id, size_t datalen, const uint8_t *data) {
|
void ftcan_msg_received_cb(uint16_t id, size_t datalen, const uint8_t *data) {
|
||||||
switch (id) {
|
switch (id) {
|
||||||
case CAN_ID_AMS_STATUS:
|
case CAN_ID_AMS_STATUS:
|
||||||
|
|
Loading…
Reference in New Issue