Show true raw input value on radio analogs diagnose screen for FlySky hall gimbals (signed short).
This commit is contained in:
committed by
Raphael Coeffic
parent
3b937387d8
commit
4af5adecef
@@ -1,7 +1,8 @@
|
||||
/*
|
||||
* Copyright (C) OpenTX
|
||||
* Copyright (C) EdgeTX
|
||||
*
|
||||
* Based on code named
|
||||
* opentx - https://github.com/opentx/opentx
|
||||
* th9x - http://code.google.com/p/th9x
|
||||
* er9x - http://code.google.com/p/er9x
|
||||
* gruvin9x - http://code.google.com/p/gruvin9x
|
||||
@@ -19,124 +20,7 @@
|
||||
*/
|
||||
|
||||
#include "opentx.h"
|
||||
|
||||
#define HALLSTICK_BUFF_SIZE ( 512 )
|
||||
#define FLYSKY_HALL_BAUDRATE ( 921600 )
|
||||
#define FLYSKY_HALL_CHANNEL_COUNT ( 4 )
|
||||
|
||||
#define MAX_ADC_CHANNEL_VALUE ( 4095 )
|
||||
#define MIN_ADC_CHANNLE_VALUE ( 0 )
|
||||
#define MIDDLE_ADC_CHANNLE_VALUE ( 2047 )
|
||||
|
||||
#define FLYSKY_HALL_PROTOLO_HEAD 0x55
|
||||
#define FLYSKY_HALL_RESP_TYPE_CALIB 0x0e
|
||||
#define FLYSKY_HALL_RESP_TYPE_VALUES 0x0c
|
||||
#define FLYSKY_HALL_ERROR_OFFSET 10
|
||||
|
||||
typedef struct
|
||||
{
|
||||
signed short min;
|
||||
signed short mid;
|
||||
signed short max;
|
||||
} STRUCT_STICK_CALIBRATION;
|
||||
|
||||
typedef struct
|
||||
{
|
||||
STRUCT_STICK_CALIBRATION sticksCalibration[4];
|
||||
unsigned char reststate;
|
||||
unsigned short CRC16;
|
||||
} STRUCT_STICK_CALIBRATION_PACK;
|
||||
|
||||
typedef struct
|
||||
{
|
||||
signed short channel[4];
|
||||
unsigned char stickState;
|
||||
unsigned short CRC16;
|
||||
} STRUCT_CHANNEL_PACK;
|
||||
|
||||
typedef union
|
||||
{
|
||||
STRUCT_STICK_CALIBRATION_PACK channelPack;
|
||||
STRUCT_CHANNEL_PACK sticksCalibrationPack;
|
||||
} UNION_DATA;
|
||||
|
||||
typedef struct
|
||||
{
|
||||
unsigned char start;
|
||||
unsigned char senderID:2;
|
||||
unsigned char receiverID:2;
|
||||
unsigned char packetID:4;
|
||||
unsigned char length;
|
||||
UNION_DATA payload;
|
||||
} STRUCT_HALLDATA;
|
||||
|
||||
typedef struct
|
||||
{
|
||||
unsigned char senderID:2;
|
||||
unsigned char receiverID:2;
|
||||
unsigned char packetID:4;
|
||||
} STRUCT_HALLID;
|
||||
|
||||
typedef union
|
||||
{
|
||||
STRUCT_HALLID hall_Id;
|
||||
unsigned char ID;
|
||||
} STRUCT_ID;
|
||||
|
||||
|
||||
typedef union
|
||||
{
|
||||
STRUCT_HALLDATA halldat;
|
||||
unsigned char buffer[30];
|
||||
} UNION_HALLDATA;
|
||||
|
||||
|
||||
typedef struct
|
||||
{
|
||||
unsigned char head;
|
||||
STRUCT_ID hallID;
|
||||
unsigned char length;
|
||||
unsigned char data[HALLSTICK_BUFF_SIZE];
|
||||
unsigned char reserved[15];
|
||||
unsigned short checkSum;
|
||||
unsigned char stickState;
|
||||
unsigned char startIndex;
|
||||
unsigned char endIndex;
|
||||
unsigned char index;
|
||||
unsigned char dataIndex;
|
||||
unsigned char deindex;
|
||||
unsigned char completeFlg;
|
||||
unsigned char status;
|
||||
unsigned char recevied;
|
||||
unsigned char msg_OK;
|
||||
} STRUCT_HALL;
|
||||
|
||||
enum
|
||||
{
|
||||
GET_START = 0,
|
||||
GET_ID,
|
||||
GET_LENGTH,
|
||||
GET_DATA,
|
||||
GET_STATE,
|
||||
GET_CHECKSUM,
|
||||
CHECKSUM,
|
||||
};
|
||||
|
||||
enum HALLSTICK_SEND_STATE_E {
|
||||
HALLSTICK_SEND_STATE_IDLE,
|
||||
HALLSTICK_STATE_SEND_RESET,
|
||||
HALLSTICK_STATE_GET_CONFIG,
|
||||
HALLSTICK_STATE_GET_FIRMWARE,
|
||||
HALLSTICK_STATE_UPDATE_FW
|
||||
};
|
||||
|
||||
enum TRANSFER_DIR_E {
|
||||
TRANSFER_DIR_HALLSTICK,
|
||||
TRANSFER_DIR_TXMCU,
|
||||
TRANSFER_DIR_HOSTPC,
|
||||
TRANSFER_DIR_RFMODULE,
|
||||
};
|
||||
|
||||
#include "flyskyHallStick_driver.h"
|
||||
|
||||
DMAFifo<HALLSTICK_BUFF_SIZE> hallDMAFifo __DMA (FLYSKY_HALL_DMA_Stream_RX);
|
||||
Fifo<uint8_t, HALLSTICK_BUFF_SIZE> hallStickTxFifo;
|
||||
|
||||
Reference in New Issue
Block a user