Diff: KondoServoLibrary/KondoServo.h

Revision:

0:411ab20ce87d

diff -r 000000000000 -r 411ab20ce87d KondoServoLibrary/KondoServo.h
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/KondoServoLibrary/KondoServo.h	Fri Apr 26 11:34:44 2019 +0000
@@ -0,0 +1,30 @@
+#ifndef __KONDO_SERVO_H__
+#define __KONDO_SERVO_H__
+
+#include "mbed.h"
+#include "SerialHalfDuplex.h"
+
+typedef enum ServoMode{single = 0,multi = 1}s_mode;
+typedef unsigned char u8;
+
+class KondoServo{
+    protected:
+        unsigned int baudrate;
+        s_mode mode; 
+        //SerialHalfDuplex master;
+
+    public:        
+        SerialHalfDuplex master;
+        void init(int baud);
+        void init();
+        
+        void setSpeed(int id, u8 speed);
+        float readSpeed(int id);
+        void set_degree(int id,float degree);
+        void setID(u8 id);
+        u8 readID();
+        ~KondoServo();
+        KondoServo(PinName txPin,PinName rxPin, int quantity=2, unsigned int baud=115200);
+
+};
+#endif
\ No newline at end of file