-
Notifications
You must be signed in to change notification settings - Fork 1
/
Copy pathAno_DT.h
131 lines (122 loc) · 3.97 KB
/
Ano_DT.h
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
#ifndef _DATA_TRANSFER_H
#define _DATA_TRANSFER_H
#include "stm32f4xx.h"
typedef struct
{
u8 msg_id;
u8 msg_data;
u8 send_check;
u8 send_version;
u8 send_status;
u8 send_senser;
u8 send_senser2;
u8 send_rcdata;
u8 send_offset;
u8 send_motopwm;
u8 send_power;
u8 send_user;
u8 send_speed;
u8 send_sensorsta;
u8 send_location;
u8 send_omv_ct;
u8 send_omv_lt;
u8 send_vef;
u16 send_parame;
u16 paraToSend;
} dt_flag_t;
#define PAR_PID_1_P 1
#define PAR_PID_1_I 2
#define PAR_PID_1_D 3
#define PAR_PID_2_P 4
#define PAR_PID_2_I 5
#define PAR_PID_2_D 6
#define PAR_PID_3_P 7
#define PAR_PID_3_I 8
#define PAR_PID_3_D 9
#define PAR_PID_4_P 10
#define PAR_PID_4_I 11
#define PAR_PID_4_D 12
#define PAR_PID_5_P 13
#define PAR_PID_5_I 14
#define PAR_PID_5_D 15
#define PAR_PID_6_P 16
#define PAR_PID_6_I 17
#define PAR_PID_6_D 18
#define PAR_PID_7_P 19
#define PAR_PID_7_I 20
#define PAR_PID_7_D 21
#define PAR_PID_8_P 22
#define PAR_PID_8_I 23
#define PAR_PID_8_D 24
#define PAR_PID_9_P 25
#define PAR_PID_9_I 26
#define PAR_PID_9_D 27
#define PAR_PID_10_P 28
#define PAR_PID_10_I 29
#define PAR_PID_10_D 30
#define PAR_PID_11_P 31
#define PAR_PID_11_I 32
#define PAR_PID_11_D 33
#define PAR_PID_12_P 34
#define PAR_PID_12_I 35
#define PAR_PID_12_D 36
#define PAR_PID_13_P 37
#define PAR_PID_13_I 38
#define PAR_PID_13_D 39
#define PAR_PID_14_P 40
#define PAR_PID_14_I 41
#define PAR_PID_14_D 42
#define PAR_PID_15_P 43
#define PAR_PID_15_I 44
#define PAR_PID_15_D 45
#define PAR_PID_16_P 46
#define PAR_PID_16_I 47
#define PAR_PID_16_D 48
#define PAR_PID_17_P 49
#define PAR_PID_17_I 50
#define PAR_PID_17_D 51
#define PAR_PID_18_P 52
#define PAR_PID_18_I 53
#define PAR_PID_18_D 54
#define PAR_RCINMODE 61
#define PAR_UNLOCKPWM 62
#define PAR_LVWARN 63
#define PAR_LVRETN 64
#define PAR_LVDOWN 65
#define PAR_CENPOSX 66
#define PAR_CENPOSY 67
#define PAR_CENPOSZ 68
#define PAR_TAKEOFFHIGH 69
#define PAR_TAKEOFFSPEED 70
#define PAR_LANDSPEED 71
#define PAR_HEATSWITCH 72
extern s32 ParValList[100];
extern dt_flag_t f;
void ANO_DT_Data_Receive_Anl_Task(void);
void ANO_DT_Send_VER(void);
void ANO_DT_Data_Exchange(void);
void ANO_DT_Data_Receive_Prepare(u8 data);
void ANO_DT_Data_Receive_Anl(u8 *data_buf,u8 num);
void ANO_DT_Send_Version(u8 hardware_type, u16 hardware_ver,u16 software_ver,u16 protocol_ver,u16 bootloader_ver);
void ANO_DT_Send_Status(float angle_rol, float angle_pit, float angle_yaw, s32 alt, u8 fly_model, u8 armed);
void ANO_DT_Send_Senser(s16 a_x,s16 a_y,s16 a_z,s16 g_x,s16 g_y,s16 g_z,s16 m_x,s16 m_y,s16 m_z);
void ANO_DT_Send_Senser2(s32 bar_alt,s32 csb_alt, s16 sensertmp);
void ANO_DT_Send_RCData(u16 thr,u16 yaw,u16 rol,u16 pit,u16 aux1,u16 aux2,u16 aux3,u16 aux4,u16 aux5,u16 aux6);
void ANO_DT_Send_Power(u16 votage, u16 current);
void ANO_DT_Send_MotoPWM(u16 m_1,u16 m_2,u16 m_3,u16 m_4,u16 m_5,u16 m_6,u16 m_7,u16 m_8);
void ANO_DT_Send_PID(u8 group,float p1_p,float p1_i,float p1_d,float p2_p,float p2_i,float p2_d,float p3_p,float p3_i,float p3_d);
void ANO_DT_Send_User(void);
void ANO_DT_Send_Speed(float,float,float);
void ANO_DT_SendSensorSta(u8 of_sta,u8 gps_sta,u8 opmv_sta,u8 uwb_sta,u8 altadd_sta);
void ANO_DT_Send_Location(u8 state,u8 sat_num,s32 lon,s32 lat,float back_home_angle,float back_home_dist);
void ANO_DT_SendCenterPos(float x,float y,float z);
void ANO_DT_SendParame(u16 num);
void ANO_DT_GetParame(u16 num,s32 data);
void ANO_DT_ParListToParUsed(void);
void ANO_DT_ParUsedToParList(void);
void ANO_DT_SendCmd(u8 dest, u8 fun, u16 cmd1, u16 cmd2, u16 cmd3, u16 cmd4, u16 cmd5);
void ANO_DT_SendString(const char *str);
void ANO_DT_SendStrVal(const char *str, s32 val);
void ANO_DT_SendOmvCt(u8 color, u8 sta, s16 x, s16 y, u8 d_tim);
void ANO_DT_SendOmvLt(u8 sta, s16 angle, s16 offset, u8 pflag, s16 x, s16 y, u8 d_tim);
#endif