forked from ToumaKazusa/Tracking360
-
Notifications
You must be signed in to change notification settings - Fork 0
/
PCA9685Driver.h
87 lines (76 loc) · 1.75 KB
/
PCA9685Driver.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
#ifdef __cplusplus
extern "C"{
#endif
#ifndef PCA9685_H
#define PCA9685_H
typedef enum
{
MODE1 = 0x00,
MODE2 = 0x01,
SUBADR1 = 0x02,
SUBADR2 = 0x03,
SUBADR3 = 0x04,
PRESCALE = 0xFE,
LED0_ON_L = 0x06,
LED0_ON_H = 0x07,
LED0_OFF_L = 0x08,
LED0_OFF_H = 0x09,
ALL_LED_ON_L = 0xFA,
ALL_LED_ON_H = 0xFB,
ALL_LED_OFF_L = 0xFC,
ALL_LED_OFF_H = 0xFD,
} Registers;
typedef enum
{
RESTART = 0x80,
SLEEP = 0x10,
ALLCALL = 0x01,
INVRT = 0x10,
OUTDRV = 0x04,
} Commands;
typedef enum
{
left,
right,
} HDirection;
typedef enum
{
up,
down,
} VDirection;
struct PCA9685DriverType
{
int deviceId;
int bDebug;
int errono;
int fd;
float controlRefinements;
};
struct MotorDescriptiorType
{
float period_min;
float period_mid;
float period_max;
float PWMFrq;
int PWMPrd;
int RangeOfMotion;
};
struct Track360MotorControlType
{
struct MotorDescriptiorType motor;
struct PCA9685DriverType pca9685;
int MinPWTck;
float PWTckPerDeg;
int bDebug;
int curPosTilt;
int curPosPan;
};
void Track360MtrCtrl_Init(struct Track360MotorControlType* self);
void Track360MtrCtrl_Tilt(struct Track360MotorControlType* self, int degree);
void Track360MtrCtrl_Pan(struct Track360MotorControlType* self, int degree);
void Track360MtrCtrl_TiltFrmCurPos(struct Track360MotorControlType* self, int degree, VDirection direction);
void Track360MtrCtrl_PanFrmCurPos(struct Track360MotorControlType* self, int degree, HDirection direction);
#endif
#ifdef __cplusplus
}
#endif