0.5

Dependencies:   mbed PID QEI2 MotorDrivers Filter

define.h

Committer:
sink
Date:
2019-11-19
Revision:
0:c2f05c36e357

File content as of revision 0:c2f05c36e357:

#define INT_TIME 0.05

#define RESO 48

#define SB_ADRS1 128
#define SB_ADRS2 129

#define LIMIT_CMD 127

#define REF_SPD1_1 (RESO*4*(5.5))//右端
#define REF_SPD1_2 (RESO*4*4)
#define REF_SPD2_1 (RESO*4*(5.5))//真ん中
#define REF_SPD2_2 (RESO*4*4)
#define REF_SPD3_1 (RESO*4*6.1)//右下
#define REF_SPD3_2 (RESO*4*(2.2))

#define P1 (0.12*INT_TIME)
#define D1 0.0000

#define P2 (0.12*INT_TIME)
#define D2 0.0000

#define LIMITER_ACCEL 250
#define LIMITER_DECCEL 250

#define POWER_ON 1
#define POWER_OFF 0

#define F1_ON 1
#define F1_OFF (!F1_ON)
#define F2_ON 1
#define F2_OFF (!F2_ON)
#define F3_ON 1
#define F3_OFF (!F3_ON)
#define F4_ON 1
#define F4_OFF (!F4_ON)

#define CB_COLLECT 0b00000001
#define AUTOMATION 0b00000010

#define LOADING    0b00000100
#define POINTS_1   0b00001000
#define POINTS_2   0b00010000
#define POINTS_3   0b00100000
#define POSITIONS  0b10000000
#define EMERGENCY  0b01000000

#define EMER_COUNT 50