From 63b863815e38762df2d73fb96178bdc50b45c232 Mon Sep 17 00:00:00 2001
From: =?UTF-8?q?Sergi=20Hern=C3=A1ndez?= <shernand@iri.upc.edu>
Date: Tue, 16 Aug 2016 12:49:07 +0200
Subject: [PATCH] Added some new servo identifiers and a function to detect if
the model is a servo or not.
---
include/dyn_servos.h | 10 ++++++++++
1 file changed, 10 insertions(+)
diff --git a/include/dyn_servos.h b/include/dyn_servos.h
index eb6619d..2034297 100755
--- a/include/dyn_servos.h
+++ b/include/dyn_servos.h
@@ -2,9 +2,14 @@
#define _DYN_SERVOS_H
// servo models
+#define SERVO_DX113 0x0071
+#define SERVO_DX116 0x0074
+#define SERVO_DX117 0x0075
#define SERVO_AX12A 0x000C
#define SERVO_AX12W 0x012C
#define SERVO_AX18A 0x0012
+#define SERVO_RX10 0x000A
+#define SERVO_MX12W 0x0168
#define SERVO_MX28 0x001D
#define SERVO_RX24F 0x0018
#define SERVO_RX28 0x001C
@@ -14,6 +19,11 @@
#define SERVO_MX106 0x0140
#define SERVO_XL320 0x015E
+#define IS_SERVO(model) (model==SERVO_DX113 || model==SERVO_DX116 || model==SERVO_DX117 || model==SERVO_AX12A \
+ model==SERVO_AX12W || model==SERVO_AX18A || model==SERVO_RX10 || model==SERVO_MX12W \
+ model==SERVO_MX28 || model==SERVO_RX24F || model==SERVO_RX28 || model==SERVO_RX64 \
+ model==SERVO_MX64 || model==SERVO_EX106 || model==SERVO_MX106 || model==SERVO_XL320)
+
// Servo register map
typedef enum{
P_MODEL_NUMBER_L = 0,
--
GitLab