Jared DiCarlo
/
foc-ed_in_the_bot_compact
working version
Fork of foc-ed_in_the_bot_compact by
config.h@10:f49df0fe0382, 2016-05-19 (annotated)
- Committer:
- bwang
- Date:
- Thu May 19 09:30:55 2016 +0000
- Revision:
- 10:f49df0fe0382
- Parent:
- 9:074575151e4b
- Child:
- 12:5723a4fa5864
all motor settings now in config.h
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
bwang | 0:bac9c3a3a6ca | 1 | #ifndef __CONFIG_H |
bwang | 0:bac9c3a3a6ca | 2 | #define __CONFIG_H |
bwang | 0:bac9c3a3a6ca | 3 | |
bwang | 10:f49df0fe0382 | 4 | #define POS_OFFSET 1.73f |
bwang | 9:074575151e4b | 5 | #define POLE_PAIRS 3.0f |
bwang | 9:074575151e4b | 6 | #define RESOLVER_LOBES 3.0f |
bwang | 10:f49df0fe0382 | 7 | #define CURRENT_U ia |
bwang | 10:f49df0fe0382 | 8 | #define CURRENT_V ib |
bwang | 10:f49df0fe0382 | 9 | #define CPR 4096 |
bwang | 0:bac9c3a3a6ca | 10 | |
bwang | 0:bac9c3a3a6ca | 11 | #define PWMA PA_8 |
bwang | 0:bac9c3a3a6ca | 12 | #define PWMB PA_9 |
bwang | 0:bac9c3a3a6ca | 13 | #define PWMC PA_10 |
bwang | 0:bac9c3a3a6ca | 14 | #define EN PB_15 |
bwang | 0:bac9c3a3a6ca | 15 | |
bwang | 0:bac9c3a3a6ca | 16 | #define IA PA_4 |
bwang | 0:bac9c3a3a6ca | 17 | #define IB PB_0 |
bwang | 0:bac9c3a3a6ca | 18 | |
bwang | 0:bac9c3a3a6ca | 19 | #define I_SCALE_RAW 25.0f //mv/A |
bwang | 0:bac9c3a3a6ca | 20 | #define R_UP 12000.0f //ohms |
bwang | 0:bac9c3a3a6ca | 21 | #define R_DOWN 3600.0f //ohms |
bwang | 0:bac9c3a3a6ca | 22 | #define R_BIAS 3600.0f //ohms |
bwang | 0:bac9c3a3a6ca | 23 | #define AVDD 3300.0f //mV |
bwang | 0:bac9c3a3a6ca | 24 | |
bwang | 0:bac9c3a3a6ca | 25 | #define I_OFFSET (AVDD * R_DOWN * R_UP / (R_DOWN * R_UP + R_BIAS * (R_DOWN + R_UP))) |
bwang | 0:bac9c3a3a6ca | 26 | #define I_SCALE (R_BIAS * R_DOWN * I_SCALE_RAW / (R_DOWN * R_UP + R_BIAS * (R_DOWN + R_UP))) |
bwang | 0:bac9c3a3a6ca | 27 | |
bwang | 9:074575151e4b | 28 | #define BUS_VOLTAGE 20.0f |
bwang | 2:eabe8feaaabb | 29 | #define K_LOOP 1.0f |
bwang | 0:bac9c3a3a6ca | 30 | #define KI_BASE 0.01f |
bwang | 0:bac9c3a3a6ca | 31 | |
bwang | 0:bac9c3a3a6ca | 32 | #define KP (K_LOOP / BUS_VOLTAGE) |
bwang | 0:bac9c3a3a6ca | 33 | #define KI (KI_BASE * K_LOOP / BUS_VOLTAGE) |
bwang | 0:bac9c3a3a6ca | 34 | |
bwang | 2:eabe8feaaabb | 35 | #define INTEGRAL_MAX 1.0f |
bwang | 2:eabe8feaaabb | 36 | |
bwang | 9:074575151e4b | 37 | #define set_dtc(phase, value) *phase = (value) |
bwang | 9:074575151e4b | 38 | #define PI 3.141593f |
bwang | 9:074575151e4b | 39 | |
bwang | 0:bac9c3a3a6ca | 40 | #endif |