|
@@ -18,6 +18,10 @@ |
|
@@ -18,6 +18,10 @@ |
|
18
|
#include "Gimbal/Gimbal_MotorFineTuning/MotorFineTuning.h"
|
18
|
#include "Gimbal/Gimbal_MotorFineTuning/MotorFineTuning.h"
|
|
19
|
|
19
|
|
|
20
|
#include "BaseConfig.h"
|
20
|
#include "BaseConfig.h"
|
|
|
|
21
|
+#include "Hal_Send/HalSend.h"
|
|
|
|
22
|
+
|
|
|
|
23
|
+//云台使用的模式, 当前有透传模式和独立模式
|
|
|
|
24
|
+static int g_Gimbal_Mode = JZ_FLAGCODE_OFF;
|
|
21
|
|
25
|
|
|
22
|
//数值角度记录
|
26
|
//数值角度记录
|
|
23
|
static int Gimbal_PitchAngle = 0; //俯仰角度 //控制云台上相机相对于水平面的上下移动。
|
27
|
static int Gimbal_PitchAngle = 0; //俯仰角度 //控制云台上相机相对于水平面的上下移动。
|
|
@@ -124,14 +128,40 @@ T_JZsdkReturnCode Gimbal_Set_PitchAngle(int angle) |
|
@@ -124,14 +128,40 @@ T_JZsdkReturnCode Gimbal_Set_PitchAngle(int angle) |
|
124
|
{
|
128
|
{
|
|
125
|
return JZ_ERROR_SYSTEM_MODULE_CODE_FAILURE;
|
129
|
return JZ_ERROR_SYSTEM_MODULE_CODE_FAILURE;
|
|
126
|
}
|
130
|
}
|
|
127
|
-
|
|
|
|
128
|
- if (angle < MIN_PITCH || angle > MAX_PITCH || (MIN_PITCH == MAX_PITCH))
|
131
|
+
|
|
|
|
132
|
+ //根据当前的云台模式来选择设置方案
|
|
|
|
133
|
+ switch (g_Gimbal_Mode)
|
|
129
|
{
|
134
|
{
|
|
130
|
- printf("云台俯仰输入值范围出错:%d\n", angle);
|
|
|
|
131
|
- return JZ_ERRORCODE_GIMBAL_INVALID_PITCH;
|
135
|
+ //独立模式
|
|
|
|
136
|
+ case JZ_MODULE_CONTROL_WAY_INDEPENDENT:
|
|
|
|
137
|
+ {
|
|
|
|
138
|
+ if (angle < MIN_PITCH || angle > MAX_PITCH || (MIN_PITCH == MAX_PITCH))
|
|
|
|
139
|
+ {
|
|
|
|
140
|
+ printf("云台俯仰输入值范围出错:%d\n", angle);
|
|
|
|
141
|
+ return JZ_ERRORCODE_GIMBAL_INVALID_PITCH;
|
|
|
|
142
|
+ }
|
|
|
|
143
|
+
|
|
|
|
144
|
+ Gimbal_PitchAngle = angle;
|
|
|
|
145
|
+ }
|
|
|
|
146
|
+ break;
|
|
|
|
147
|
+
|
|
|
|
148
|
+ //透传模式
|
|
|
|
149
|
+ case JZ_MODULE_CONTROL_WAY_TRANSPARENT:
|
|
|
|
150
|
+ {
|
|
|
|
151
|
+ Gimbal_PitchAngle = angle;
|
|
|
|
152
|
+ }
|
|
|
|
153
|
+ break;
|
|
|
|
154
|
+
|
|
|
|
155
|
+ case JZ_FLAGCODE_OFF:
|
|
|
|
156
|
+ JZSDK_LOG_ERROR("云台未开启");
|
|
|
|
157
|
+ return JZ_ERROR_SYSTEM_MODULE_CODE_FAILURE;
|
|
|
|
158
|
+ break;
|
|
|
|
159
|
+
|
|
|
|
160
|
+ default:
|
|
|
|
161
|
+ JZSDK_LOG_ERROR("云台模式错误");
|
|
|
|
162
|
+ return JZ_ERROR_SYSTEM_MODULE_CODE_FAILURE;
|
|
|
|
163
|
+ break;
|
|
132
|
}
|
164
|
}
|
|
133
|
-
|
|
|
|
134
|
- Gimbal_PitchAngle = angle;
|
|
|
|
135
|
|
165
|
|
|
136
|
return JZ_ERROR_SYSTEM_MODULE_CODE_SUCCESS;
|
166
|
return JZ_ERROR_SYSTEM_MODULE_CODE_SUCCESS;
|
|
137
|
}
|
167
|
}
|
|
@@ -160,17 +190,43 @@ T_JZsdkReturnCode Gimbal_SetGimbalRange(int flag, int value) |
|
@@ -160,17 +190,43 @@ T_JZsdkReturnCode Gimbal_SetGimbalRange(int flag, int value) |
|
160
|
{
|
190
|
{
|
|
161
|
JZSDK_LOG_INFO("设置云台范围最大最小值 flag:%d 0x%x", flag, value);
|
191
|
JZSDK_LOG_INFO("设置云台范围最大最小值 flag:%d 0x%x", flag, value);
|
|
162
|
|
192
|
|
|
163
|
- switch (flag)
|
193
|
+ //根据云台模式来选择设置方案
|
|
|
|
194
|
+ switch (g_Gimbal_Mode)
|
|
164
|
{
|
195
|
{
|
|
165
|
- case 0:
|
|
|
|
166
|
- return Gimbal_DataDeal_SetPitchRange(value);
|
196
|
+ //独立模式
|
|
|
|
197
|
+ case JZ_MODULE_CONTROL_WAY_INDEPENDENT:
|
|
|
|
198
|
+ {
|
|
|
|
199
|
+ switch (flag)
|
|
|
|
200
|
+ {
|
|
|
|
201
|
+ case 0:
|
|
|
|
202
|
+ return Gimbal_DataDeal_SetPitchRange(value);
|
|
|
|
203
|
+ break;
|
|
|
|
204
|
+
|
|
|
|
205
|
+ default:
|
|
|
|
206
|
+ break;
|
|
|
|
207
|
+ }
|
|
|
|
208
|
+ }
|
|
167
|
break;
|
209
|
break;
|
|
168
|
-
|
210
|
+
|
|
|
|
211
|
+ //透传模式
|
|
|
|
212
|
+ case JZ_MODULE_CONTROL_WAY_TRANSPARENT:
|
|
|
|
213
|
+ {
|
|
|
|
214
|
+ //透传模式暂时无法设置云台范围
|
|
|
|
215
|
+ }
|
|
|
|
216
|
+ break;
|
|
|
|
217
|
+
|
|
|
|
218
|
+ case JZ_FLAGCODE_OFF:
|
|
|
|
219
|
+ JZSDK_LOG_ERROR("云台未开启");
|
|
|
|
220
|
+ return JZ_ERROR_SYSTEM_MODULE_CODE_FAILURE;
|
|
|
|
221
|
+ break;
|
|
|
|
222
|
+
|
|
169
|
default:
|
223
|
default:
|
|
170
|
- break;
|
224
|
+ JZSDK_LOG_ERROR("云台模式错误");
|
|
|
|
225
|
+ return JZ_ERROR_SYSTEM_MODULE_CODE_FAILURE;
|
|
|
|
226
|
+ break;
|
|
171
|
}
|
227
|
}
|
|
172
|
-
|
|
|
|
173
|
- return JZ_ERROR_SYSTEM_MODULE_CODE_FAILURE;
|
228
|
+
|
|
|
|
229
|
+ return JZ_ERROR_SYSTEM_MODULE_CODE_SUCCESS;
|
|
174
|
}
|
230
|
}
|
|
175
|
|
231
|
|
|
176
|
//查询云台微调值
|
232
|
//查询云台微调值
|
|
@@ -178,13 +234,37 @@ T_JZsdkReturnCode Gimbal_CheckStatus_GimbalFineTuning(int *FineTuningPitch, int |
|
@@ -178,13 +234,37 @@ T_JZsdkReturnCode Gimbal_CheckStatus_GimbalFineTuning(int *FineTuningPitch, int |
|
178
|
{
|
234
|
{
|
|
179
|
JZSDK_LOG_DEBUG("查询云台微调值");
|
235
|
JZSDK_LOG_DEBUG("查询云台微调值");
|
|
180
|
|
236
|
|
|
181
|
-//组合机需要去获取另外一个设备的值
|
|
|
|
182
|
-#if DEVICE_VERSION == JZ_H1T
|
|
|
|
183
|
- //1、刷新微调值
|
|
|
|
184
|
- JZsdk_Uart_Send_CheckStatus_GimbalFineTuningPitch(UART_DEV_1, 0);
|
237
|
+ switch (g_Gimbal_Mode)
|
|
|
|
238
|
+ {
|
|
|
|
239
|
+ //独立模式
|
|
|
|
240
|
+ case JZ_MODULE_CONTROL_WAY_INDEPENDENT:
|
|
|
|
241
|
+ {
|
|
|
|
242
|
+ //独立模式无需另外操作
|
|
|
|
243
|
+ }
|
|
|
|
244
|
+ break;
|
|
185
|
|
245
|
|
|
186
|
- delayMs(10);
|
246
|
+ //透传模式
|
|
|
|
247
|
+ case JZ_MODULE_CONTROL_WAY_TRANSPARENT:
|
|
|
|
248
|
+ {
|
|
|
|
249
|
+ //向透传目标索要刷新微调值
|
|
|
|
250
|
+#if DEVICE_VERSION == JZ_H1T
|
|
|
|
251
|
+ HalSend_type1Send_CheckStatus_GimbalFineTuningPitch(UART_DEV_1, 0);
|
|
|
|
252
|
+ delayMs(10);
|
|
187
|
#endif
|
253
|
#endif
|
|
|
|
254
|
+ }
|
|
|
|
255
|
+ break;
|
|
|
|
256
|
+
|
|
|
|
257
|
+ case JZ_FLAGCODE_OFF:
|
|
|
|
258
|
+ JZSDK_LOG_ERROR("云台未开启");
|
|
|
|
259
|
+ return JZ_ERROR_SYSTEM_MODULE_CODE_FAILURE;
|
|
|
|
260
|
+ break;
|
|
|
|
261
|
+
|
|
|
|
262
|
+ default:
|
|
|
|
263
|
+ JZSDK_LOG_ERROR("云台模式错误");
|
|
|
|
264
|
+ return JZ_ERROR_SYSTEM_MODULE_CODE_FAILURE;
|
|
|
|
265
|
+ break;
|
|
|
|
266
|
+
|
|
|
|
267
|
+ }
|
|
188
|
|
268
|
|
|
189
|
if (FineTuningPitch != NULL)
|
269
|
if (FineTuningPitch != NULL)
|
|
190
|
{
|
270
|
{
|
|
@@ -209,14 +289,35 @@ T_JZsdkReturnCode Gimbal_Obtain_GimbalFineTuning(int pitch, int yaw, int roll) |
|
@@ -209,14 +289,35 @@ T_JZsdkReturnCode Gimbal_Obtain_GimbalFineTuning(int pitch, int yaw, int roll) |
|
209
|
{
|
289
|
{
|
|
210
|
printf("收到云台pitch云台微调值\n");
|
290
|
printf("收到云台pitch云台微调值\n");
|
|
211
|
|
291
|
|
|
212
|
-//组合机需要记录另外一个设备的值
|
|
|
|
213
|
-#if DEVICE_VERSION == JZ_H1T
|
|
|
|
214
|
- g_MotorFineTuningPitch = pitch;
|
|
|
|
215
|
-#else
|
|
|
|
216
|
- return JZ_ERROR_SYSTEM_MODULE_CODE_FAILURE;
|
|
|
|
217
|
-#endif
|
292
|
+ switch (g_Gimbal_Mode)
|
|
|
|
293
|
+ {
|
|
|
|
294
|
+ //独立模式
|
|
|
|
295
|
+ case JZ_MODULE_CONTROL_WAY_INDEPENDENT:
|
|
|
|
296
|
+ {
|
|
|
|
297
|
+ //独立模式无该概念
|
|
|
|
298
|
+ return JZ_ERROR_SYSTEM_MODULE_CODE_FAILURE;
|
|
|
|
299
|
+ }
|
|
|
|
300
|
+ break;
|
|
218
|
|
301
|
|
|
219
|
- return JZ_ERROR_SYSTEM_MODULE_CODE_FAILURE;
|
302
|
+ //透传模式
|
|
|
|
303
|
+ case JZ_MODULE_CONTROL_WAY_TRANSPARENT:
|
|
|
|
304
|
+ {
|
|
|
|
305
|
+ g_MotorFineTuningPitch = pitch;
|
|
|
|
306
|
+ }
|
|
|
|
307
|
+ break;
|
|
|
|
308
|
+
|
|
|
|
309
|
+ case JZ_FLAGCODE_OFF:
|
|
|
|
310
|
+ JZSDK_LOG_ERROR("云台未开启");
|
|
|
|
311
|
+ return JZ_ERROR_SYSTEM_MODULE_CODE_FAILURE;
|
|
|
|
312
|
+ break;
|
|
|
|
313
|
+
|
|
|
|
314
|
+ default:
|
|
|
|
315
|
+ JZSDK_LOG_ERROR("云台模式错误");
|
|
|
|
316
|
+ return JZ_ERROR_SYSTEM_MODULE_CODE_FAILURE;
|
|
|
|
317
|
+ break;
|
|
|
|
318
|
+ }
|
|
|
|
319
|
+
|
|
|
|
320
|
+ return JZ_ERROR_SYSTEM_MODULE_CODE_SUCCESS;
|
|
220
|
}
|
321
|
}
|
|
221
|
|
322
|
|
|
222
|
|
323
|
|
|
@@ -226,34 +327,57 @@ T_JZsdkReturnCode Gimbal_Set_PitchFineTuning(int pitch) |
|
@@ -226,34 +327,57 @@ T_JZsdkReturnCode Gimbal_Set_PitchFineTuning(int pitch) |
|
226
|
JZSDK_LOG_INFO("设置云台pitch云台微调值\n");
|
327
|
JZSDK_LOG_INFO("设置云台pitch云台微调值\n");
|
|
227
|
T_JZsdkReturnCode ret;
|
328
|
T_JZsdkReturnCode ret;
|
|
228
|
|
329
|
|
|
229
|
- if (pitch == 0)
|
330
|
+ switch (g_Gimbal_Mode)
|
|
230
|
{
|
331
|
{
|
|
231
|
- return JZ_ERROR_SYSTEM_MODULE_CODE_SUCCESS;
|
|
|
|
232
|
- }
|
|
|
|
233
|
-
|
|
|
|
234
|
- //设置本地微调值
|
|
|
|
235
|
- int temp_pitch = g_MotorFineTuningPitch + pitch;
|
|
|
|
236
|
- //微调值要小于20度
|
|
|
|
237
|
- if (temp_pitch >= 200)
|
|
|
|
238
|
- {
|
|
|
|
239
|
- temp_pitch = 200;
|
|
|
|
240
|
- }
|
332
|
+ //独立模式
|
|
|
|
333
|
+ case JZ_MODULE_CONTROL_WAY_INDEPENDENT:
|
|
|
|
334
|
+ {
|
|
|
|
335
|
+ if (pitch == 0)
|
|
|
|
336
|
+ {
|
|
|
|
337
|
+ return JZ_ERROR_SYSTEM_MODULE_CODE_SUCCESS;
|
|
|
|
338
|
+ }
|
|
|
|
339
|
+
|
|
|
|
340
|
+ //设置本地微调值
|
|
|
|
341
|
+ int temp_pitch = g_MotorFineTuningPitch + pitch;
|
|
|
|
342
|
+ //微调值要小于20度
|
|
|
|
343
|
+ if (temp_pitch >= 200)
|
|
|
|
344
|
+ {
|
|
|
|
345
|
+ temp_pitch = 200;
|
|
|
|
346
|
+ }
|
|
|
|
347
|
+
|
|
|
|
348
|
+ if (temp_pitch <= -200)
|
|
|
|
349
|
+ {
|
|
|
|
350
|
+ temp_pitch = -200;
|
|
|
|
351
|
+ }
|
|
|
|
352
|
+
|
|
|
|
353
|
+ g_MotorFineTuningPitch = temp_pitch;
|
|
|
|
354
|
+
|
|
|
|
355
|
+ //存储到文件
|
|
|
|
356
|
+ MotorFineTuning_WritePitch(g_MotorFineTuningPitch);
|
|
|
|
357
|
+ }
|
|
|
|
358
|
+ break;
|
|
241
|
|
359
|
|
|
242
|
- if (temp_pitch <= -200)
|
|
|
|
243
|
- {
|
|
|
|
244
|
- temp_pitch = -200;
|
|
|
|
245
|
- }
|
|
|
|
246
|
-
|
|
|
|
247
|
- g_MotorFineTuningPitch = temp_pitch;
|
|
|
|
248
|
-
|
|
|
|
249
|
- //组合机是发到另外一个设备
|
|
|
|
250
|
-#if DEVICE_VERSION == JZ_H1T
|
|
|
|
251
|
- JZsdk_Uart_Send_SetGimbalFineTuningPitch(UART_DEV_1, g_MotorFineTuningPitch);
|
|
|
|
252
|
-#else
|
360
|
+ //透传模式
|
|
|
|
361
|
+ case JZ_MODULE_CONTROL_WAY_TRANSPARENT:
|
|
|
|
362
|
+ {
|
|
|
|
363
|
+ g_MotorFineTuningPitch = pitch;
|
|
253
|
|
364
|
|
|
254
|
- //存储到文件
|
|
|
|
255
|
- MotorFineTuning_WritePitch(g_MotorFineTuningPitch);
|
|
|
|
256
|
-#endif
|
365
|
+ #if DEVICE_VERSION == JZ_H1T
|
|
|
|
366
|
+ HalSend_type1Send_Set_GimbalFineTuningPitch(UART_DEV_1, g_MotorFineTuningPitch);
|
|
|
|
367
|
+ #endif
|
|
|
|
368
|
+ }
|
|
|
|
369
|
+ break;
|
|
|
|
370
|
+
|
|
|
|
371
|
+ case JZ_FLAGCODE_OFF:
|
|
|
|
372
|
+ JZSDK_LOG_ERROR("云台未开启");
|
|
|
|
373
|
+ return JZ_ERROR_SYSTEM_MODULE_CODE_FAILURE;
|
|
|
|
374
|
+ break;
|
|
|
|
375
|
+
|
|
|
|
376
|
+ default:
|
|
|
|
377
|
+ JZSDK_LOG_ERROR("云台模式错误");
|
|
|
|
378
|
+ return JZ_ERROR_SYSTEM_MODULE_CODE_FAILURE;
|
|
|
|
379
|
+ break;
|
|
|
|
380
|
+ }
|
|
257
|
|
381
|
|
|
258
|
return JZ_ERROR_SYSTEM_MODULE_CODE_SUCCESS;
|
382
|
return JZ_ERROR_SYSTEM_MODULE_CODE_SUCCESS;
|
|
259
|
}
|
383
|
}
|
|
@@ -297,16 +421,39 @@ T_JZsdkReturnCode Gimbal_Set_GimbalLinkageControl(int value) |
|
@@ -297,16 +421,39 @@ T_JZsdkReturnCode Gimbal_Set_GimbalLinkageControl(int value) |
|
297
|
{
|
421
|
{
|
|
298
|
JZSDK_LOG_INFO("设置云台联动\n");
|
422
|
JZSDK_LOG_INFO("设置云台联动\n");
|
|
299
|
|
423
|
|
|
300
|
- g_Gimbal_Linkage = value;
|
424
|
+ switch (g_Gimbal_Mode)
|
|
|
|
425
|
+ {
|
|
|
|
426
|
+ //独立模式
|
|
|
|
427
|
+ case JZ_MODULE_CONTROL_WAY_INDEPENDENT:
|
|
|
|
428
|
+ {
|
|
|
|
429
|
+ g_Gimbal_Linkage = value;
|
|
|
|
430
|
+ }
|
|
|
|
431
|
+ break;
|
|
301
|
|
432
|
|
|
302
|
-#if DEVICE_VERSION == JZ_H1T
|
|
|
|
303
|
- JZsdk_Uart_Send_Set_GimbalLinkageControl(UART_DEV_1, 0, value);
|
|
|
|
304
|
-#else
|
|
|
|
305
|
- //暂时没做接口
|
|
|
|
306
|
-#endif
|
|
|
|
307
|
-
|
|
|
|
308
|
- return JZ_ERROR_SYSTEM_MODULE_CODE_SUCCESS;
|
433
|
+ //透传模式
|
|
|
|
434
|
+ case JZ_MODULE_CONTROL_WAY_TRANSPARENT:
|
|
|
|
435
|
+ {
|
|
|
|
436
|
+ //设置本地联动值
|
|
|
|
437
|
+ g_Gimbal_Linkage = value;
|
|
309
|
|
438
|
|
|
|
|
439
|
+ #if DEVICE_VERSION == JZ_H1T
|
|
|
|
440
|
+ HalSend_type1Send_Set_GimbalLinkageControl(UART_DEV_1, g_Gimbal_Linkage);
|
|
|
|
441
|
+ #endif
|
|
|
|
442
|
+ }
|
|
|
|
443
|
+ break;
|
|
|
|
444
|
+
|
|
|
|
445
|
+ case JZ_FLAGCODE_OFF:
|
|
|
|
446
|
+ JZSDK_LOG_ERROR("云台未开启");
|
|
|
|
447
|
+ return JZ_ERROR_SYSTEM_MODULE_CODE_FAILURE;
|
|
|
|
448
|
+ break;
|
|
|
|
449
|
+
|
|
|
|
450
|
+ default:
|
|
|
|
451
|
+ JZSDK_LOG_ERROR("云台模式错误");
|
|
|
|
452
|
+ return JZ_ERROR_SYSTEM_MODULE_CODE_FAILURE;
|
|
|
|
453
|
+ break;
|
|
|
|
454
|
+ }
|
|
|
|
455
|
+
|
|
|
|
456
|
+ return JZ_ERROR_SYSTEM_MODULE_CODE_SUCCESS;
|
|
310
|
}
|
457
|
}
|
|
311
|
|
458
|
|
|
312
|
//查询云台联动
|
459
|
//查询云台联动
|
|
@@ -314,17 +461,37 @@ T_JZsdkReturnCode Gimbal_CheckStatus_GimbalLinkage(int *value) |
|
@@ -314,17 +461,37 @@ T_JZsdkReturnCode Gimbal_CheckStatus_GimbalLinkage(int *value) |
|
314
|
{
|
461
|
{
|
|
315
|
JZSDK_LOG_INFO("查询云台联动值\n");
|
462
|
JZSDK_LOG_INFO("查询云台联动值\n");
|
|
316
|
|
463
|
|
|
317
|
-#if DEVICE_VERSION == JZ_H1T
|
|
|
|
318
|
- //1、刷新云台联动值
|
|
|
|
319
|
- JZsdk_Uart_Send_CheckStatus_GimbalLinkage(UART_DEV_1, 0);
|
464
|
+ switch (g_Gimbal_Mode)
|
|
|
|
465
|
+ {
|
|
|
|
466
|
+ case JZ_MODULE_CONTROL_WAY_INDEPENDENT:
|
|
|
|
467
|
+ {
|
|
|
|
468
|
+ //独立模式,直接返回本地值
|
|
|
|
469
|
+ *value = g_Gimbal_Linkage;
|
|
|
|
470
|
+ }
|
|
|
|
471
|
+ break;
|
|
320
|
|
472
|
|
|
321
|
- delayMs(10);
|
473
|
+ case JZ_MODULE_CONTROL_WAY_TRANSPARENT:
|
|
|
|
474
|
+ {
|
|
|
|
475
|
+ //透传模式,查询一次云台联动值
|
|
|
|
476
|
+ #if DEVICE_VERSION == JZ_H1T
|
|
|
|
477
|
+ HalSend_type1Send_CheckStatus_GimbalLinkage(UART_DEV_1, 0);
|
|
322
|
|
478
|
|
|
323
|
- //2、回复云台联动值
|
|
|
|
324
|
- *value = g_Gimbal_Linkage;
|
|
|
|
325
|
-#else
|
|
|
|
326
|
- //暂时没做接口
|
|
|
|
327
|
-#endif
|
479
|
+ delayMs(10);
|
|
|
|
480
|
+
|
|
|
|
481
|
+ *value = g_Gimbal_Linkage;
|
|
|
|
482
|
+ #endif
|
|
|
|
483
|
+ }
|
|
|
|
484
|
+
|
|
|
|
485
|
+ case JZ_FLAGCODE_OFF:
|
|
|
|
486
|
+ JZSDK_LOG_ERROR("云台未开启");
|
|
|
|
487
|
+ return JZ_ERROR_SYSTEM_MODULE_CODE_FAILURE;
|
|
|
|
488
|
+ break;
|
|
|
|
489
|
+
|
|
|
|
490
|
+ default:
|
|
|
|
491
|
+ JZSDK_LOG_ERROR("云台模式错误");
|
|
|
|
492
|
+ return JZ_ERROR_SYSTEM_MODULE_CODE_FAILURE;
|
|
|
|
493
|
+ break;
|
|
|
|
494
|
+ }
|
|
328
|
|
495
|
|
|
329
|
return JZ_ERROR_SYSTEM_MODULE_CODE_SUCCESS;
|
496
|
return JZ_ERROR_SYSTEM_MODULE_CODE_SUCCESS;
|
|
330
|
}
|
497
|
}
|
|
@@ -577,13 +744,16 @@ T_JZsdkReturnCode Gimbal_Flush_Pitch() |
|
@@ -577,13 +744,16 @@ T_JZsdkReturnCode Gimbal_Flush_Pitch() |
|
577
|
/**************************
|
744
|
/**************************
|
|
578
|
*
|
745
|
*
|
|
579
|
*
|
746
|
*
|
|
580
|
- * 云台独立控制模式初始化
|
747
|
+ * 云台透传控制模式初始化
|
|
581
|
*
|
748
|
*
|
|
582
|
*
|
749
|
*
|
|
583
|
* **************************/
|
750
|
* **************************/
|
|
584
|
static T_JZsdkReturnCode Gimbal_Init_Gimbal_Init_TransparentControl()
|
751
|
static T_JZsdkReturnCode Gimbal_Init_Gimbal_Init_TransparentControl()
|
|
585
|
{
|
752
|
{
|
|
|
|
753
|
+ //
|
|
|
|
754
|
+
|
|
586
|
|
755
|
|
|
|
|
756
|
+ return JZ_ERROR_SYSTEM_MODULE_CODE_SUCCESS;
|
|
587
|
}
|
757
|
}
|
|
588
|
|
758
|
|
|
589
|
/**************************
|
759
|
/**************************
|
|
@@ -600,6 +770,8 @@ static T_JZsdkReturnCode Gimbal_Init_IndependentControl() |
|
@@ -600,6 +770,8 @@ static T_JZsdkReturnCode Gimbal_Init_IndependentControl() |
|
600
|
|
770
|
|
|
601
|
//云台微调初始化
|
771
|
//云台微调初始化
|
|
602
|
MotorFineTuning_Init(&g_MotorFineTuningPitch, &g_MotorFineTuningYaw, &g_MotorFineTuningRoll);
|
772
|
MotorFineTuning_Init(&g_MotorFineTuningPitch, &g_MotorFineTuningYaw, &g_MotorFineTuningRoll);
|
|
|
|
773
|
+
|
|
|
|
774
|
+ return JZ_ERROR_SYSTEM_MODULE_CODE_SUCCESS;
|
|
603
|
}
|
775
|
}
|
|
604
|
|
776
|
|
|
605
|
/***************************
|
777
|
/***************************
|