Bayley Wang
/
priustroller_3
temp repo
Fork of priustroller_2 by
sensors/voltagesensors.cpp@35:83cf9564bd0c, 2015-03-16 (annotated)
- Committer:
- bwang
- Date:
- Mon Mar 16 15:40:07 2015 +0000
- Revision:
- 35:83cf9564bd0c
- Parent:
- 33:e7b132029bae
Set for 3A Iq, 0A Id, Ki = 1e-3, Kp = Kd = 0, loop still oscillates but is passable
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
bwang | 0:54cf32d35f4d | 1 | #include "includes.h" |
bwang | 1:1f58bdcf2956 | 2 | #include "sensors.h" |
bwang | 0:54cf32d35f4d | 3 | |
bwang | 0:54cf32d35f4d | 4 | AnalogVoltageSensor::AnalogVoltageSensor(PinName pin, float scale) { |
nki | 33:e7b132029bae | 5 | _in = new AnalogIn(pin); |
bwang | 0:54cf32d35f4d | 6 | _scale = scale; |
bwang | 0:54cf32d35f4d | 7 | } |
bwang | 0:54cf32d35f4d | 8 | |
bwang | 0:54cf32d35f4d | 9 | void AnalogVoltageSensor::Zero() { |
bwang | 0:54cf32d35f4d | 10 | _zero_level = (float) *_in; |
bwang | 0:54cf32d35f4d | 11 | } |
bwang | 0:54cf32d35f4d | 12 | |
bwang | 0:54cf32d35f4d | 13 | float AnalogVoltageSensor::GetVoltage() { |
bwang | 0:54cf32d35f4d | 14 | return ((float) *_in - _zero_level) * 3.3f / _scale; |
bwang | 0:54cf32d35f4d | 15 | } |