servo_/30

Dependencies:   i2cslave mbed

Committer:
sgrsn
Date:
Fri Sep 30 12:33:22 2016 +0000
Revision:
0:f7be77a7663f
servo_9/30

Who changed what in which revision?

UserRevisionLine numberNew contents of line
sgrsn 0:f7be77a7663f 1 /*Registar group*************************************/
sgrsn 0:f7be77a7663f 2
sgrsn 0:f7be77a7663f 3 #define motor1_state 0x01
sgrsn 0:f7be77a7663f 4 #define motor2_state 0x02
sgrsn 0:f7be77a7663f 5 #define motor1_pwm 0x03
sgrsn 0:f7be77a7663f 6 #define motor2_pwm 0x04
sgrsn 0:f7be77a7663f 7 #define check_reg 0x05
sgrsn 0:f7be77a7663f 8 #define PM_target_reg 0x10
sgrsn 0:f7be77a7663f 9 #define RE_target_reg 0x20
sgrsn 0:f7be77a7663f 10 #define Kp 0x30
sgrsn 0:f7be77a7663f 11 #define pid_start 0x40
sgrsn 0:f7be77a7663f 12 #define machine_state 0x45
sgrsn 0:f7be77a7663f 13 #define PM_ofset_reg 0x50
sgrsn 0:f7be77a7663f 14 #define wheel_start 0x60
sgrsn 0:f7be77a7663f 15 #define PM_start 0x70
sgrsn 0:f7be77a7663f 16
sgrsn 0:f7be77a7663f 17 /*Address group*************************************/
sgrsn 0:f7be77a7663f 18 //MD : MotorDriver
sgrsn 0:f7be77a7663f 19 #define MD1_addr 0x12
sgrsn 0:f7be77a7663f 20 #define MD2_addr 0x14
sgrsn 0:f7be77a7663f 21 #define MD3_addr 0x16
sgrsn 0:f7be77a7663f 22 #define MD4_addr 0x18
sgrsn 0:f7be77a7663f 23 #define MD5_addr 0x20
sgrsn 0:f7be77a7663f 24 #define MD6_addr 0x22
sgrsn 0:f7be77a7663f 25 #define MD7_addr 0x24
sgrsn 0:f7be77a7663f 26 #define MD8_addr 0x26
sgrsn 0:f7be77a7663f 27 #define MD9_addr 0x28
sgrsn 0:f7be77a7663f 28 #define MD10_addr 0x30
sgrsn 0:f7be77a7663f 29 #define MD11_addr 0x32
sgrsn 0:f7be77a7663f 30 #define MD12_addr 0x34
sgrsn 0:f7be77a7663f 31 #define MD13_addr 0x36
sgrsn 0:f7be77a7663f 32 #define MD14_addr 0x38
sgrsn 0:f7be77a7663f 33 #define MD15_addr 0x40
sgrsn 0:f7be77a7663f 34
sgrsn 0:f7be77a7663f 35 //CY : Cylinder
sgrsn 0:f7be77a7663f 36 #define CY1_addr 0x50
sgrsn 0:f7be77a7663f 37
sgrsn 0:f7be77a7663f 38 //SERVO : Servo motor
sgrsn 0:f7be77a7663f 39 #define SERVO1_addr 0x60
sgrsn 0:f7be77a7663f 40
sgrsn 0:f7be77a7663f 41 //SE : Sensor
sgrsn 0:f7be77a7663f 42 #define SE1_addr 0x90
sgrsn 0:f7be77a7663f 43 #define SE2_addr 0xA0
sgrsn 0:f7be77a7663f 44
sgrsn 0:f7be77a7663f 45 /*Motor movement***********************************/
sgrsn 0:f7be77a7663f 46
sgrsn 0:f7be77a7663f 47 #define Nomal 5
sgrsn 0:f7be77a7663f 48 #define Reverse 10
sgrsn 0:f7be77a7663f 49 #define Stop 3