Bayley Wang
/
foc-ed_in_the_bot_compact
robot
ThrottleMapper/ThrottleMapper.cpp@42:030e0ec4eac5, 2017-01-06 (annotated)
- Committer:
- bwang
- Date:
- Fri Jan 06 07:54:22 2017 +0000
- Revision:
- 42:030e0ec4eac5
- Child:
- 56:c681001dfa46
structural changes; reference and throttle maps now classes, global variables moved to structs, system config functions moved to BREMS/*
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
bwang | 42:030e0ec4eac5 | 1 | #include "ThrottleMapper.h" |
bwang | 42:030e0ec4eac5 | 2 | |
bwang | 42:030e0ec4eac5 | 3 | #include "config_motor.h" |
bwang | 42:030e0ec4eac5 | 4 | #include "config_inverter.h" |
bwang | 42:030e0ec4eac5 | 5 | #include "config_driving.h" |
bwang | 42:030e0ec4eac5 | 6 | |
bwang | 42:030e0ec4eac5 | 7 | float DrivingThrottleMapper::map(float throttle, float w) { |
bwang | 42:030e0ec4eac5 | 8 | float z = getZeroTqThrottle(w); |
bwang | 42:030e0ec4eac5 | 9 | float tq, tqmax; |
bwang | 42:030e0ec4eac5 | 10 | |
bwang | 42:030e0ec4eac5 | 11 | if (throttle > z) tqmax = getMaxTqpctPlus(w); |
bwang | 42:030e0ec4eac5 | 12 | if (throttle <= z) tqmax = getMaxTqpctMinus(w); |
bwang | 42:030e0ec4eac5 | 13 | |
bwang | 42:030e0ec4eac5 | 14 | if (throttle > z) tq = (throttle - z) / (1.0f - z); |
bwang | 42:030e0ec4eac5 | 15 | if (throttle <= z) tq = (throttle - z) / z; |
bwang | 42:030e0ec4eac5 | 16 | |
bwang | 42:030e0ec4eac5 | 17 | if (tq > tqmax) tq = tqmax; |
bwang | 42:030e0ec4eac5 | 18 | return tq; |
bwang | 42:030e0ec4eac5 | 19 | } |
bwang | 42:030e0ec4eac5 | 20 | |
bwang | 42:030e0ec4eac5 | 21 | float DrivingThrottleMapper::getMaxTqpctPlus(float w) { |
bwang | 42:030e0ec4eac5 | 22 | return MAX_TQPCT_PLUS; |
bwang | 42:030e0ec4eac5 | 23 | } |
bwang | 42:030e0ec4eac5 | 24 | |
bwang | 42:030e0ec4eac5 | 25 | float DrivingThrottleMapper::getMaxTqpctMinus(float w) { |
bwang | 42:030e0ec4eac5 | 26 | return MAX_TQPCT_MINUS; |
bwang | 42:030e0ec4eac5 | 27 | } |
bwang | 42:030e0ec4eac5 | 28 | |
bwang | 42:030e0ec4eac5 | 29 | float DrivingThrottleMapper::getZeroTqThrottle(float w) { |
bwang | 42:030e0ec4eac5 | 30 | float tmp = w / W_MAX; |
bwang | 42:030e0ec4eac5 | 31 | return tmp < 1.0f ? tmp : 1.0f; |
bwang | 42:030e0ec4eac5 | 32 | } |