Prius IPM controller

Dependencies:   mbed

Fork of analoghalls5_5 by N K

Committer:
bwang
Date:
Mon Mar 02 01:24:37 2015 +0000
Revision:
3:0a2396597e0d
Parent:
1:1f58bdcf2956
Child:
4:fdadf4a3577a
should turn moter

Who changed what in which revision?

UserRevisionLine numberNew contents of line
bwang 0:54cf32d35f4d 1 #include "includes.h"
bwang 1:1f58bdcf2956 2 #include "core.h"
bwang 1:1f58bdcf2956 3 #include "sensors.h"
bwang 1:1f58bdcf2956 4 #include "meta.h"
bwang 0:54cf32d35f4d 5
bwang 0:54cf32d35f4d 6 int main() {
bwang 0:54cf32d35f4d 7 PositionSensor *sense_p = new AnalogHallPositionSensor(A4, A5, 0.256f, 0.484f, 0.254f, 0.474f, 205.0f);
bwang 0:54cf32d35f4d 8 CurrentSensor *sense_ia = new AnalogCurrentSensor(A1, 0.01);
bwang 0:54cf32d35f4d 9 CurrentSensor *sense_ib = new AnalogCurrentSensor(A2, 0.01);
bwang 0:54cf32d35f4d 10 VoltageSensor *sense_bus = new AnalogVoltageSensor(A5, 0.01);
bwang 0:54cf32d35f4d 11 TempSensor *sense_t_motor = new TempSensor();
bwang 0:54cf32d35f4d 12 TempSensor *sense_t_inverter = new TempSensor();
bwang 0:54cf32d35f4d 13 Throttle *throttle = new Throttle(A0, 0.5f, 3.0f);
bwang 0:54cf32d35f4d 14
bwang 3:0a2396597e0d 15 PidController *pid_d = new PidController(1.0f, 0.0f, 0.0f, 0.0f, 1.0f);
bwang 3:0a2396597e0d 16 PidController *pid_q = new PidController (1.0f, 0.0f, 0.0f, 0.0f, 1.0f);
bwang 3:0a2396597e0d 17
bwang 0:54cf32d35f4d 18 Motor *motor = new Motor(sense_ia, sense_ib, sense_p, sense_t_motor);
bwang 0:54cf32d35f4d 19 Inverter *inverter = new Inverter(D6, D13, D3, D8, sense_bus, sense_t_inverter);
bwang 0:54cf32d35f4d 20 User *user = new User(throttle);
bwang 3:0a2396597e0d 21 Modulator *modulator = new SinusoidalModulator(inverter);
bwang 3:0a2396597e0d 22 StatusUpdater *updater = new StatusUpdater(inverter, motor, user);
bwang 3:0a2396597e0d 23 LoopDriver *driver = new LoopDriver(inverter, motor, user, pid_d, pid_q, modulator, 100.0f, 5000);
bwang 0:54cf32d35f4d 24
bwang 0:54cf32d35f4d 25 motor->Config(4, 20.0f);
bwang 3:0a2396597e0d 26 updater->Config(5000, 10);
bwang 0:54cf32d35f4d 27
bwang 3:0a2396597e0d 28 driver->Start();
bwang 3:0a2396597e0d 29 updater->Start();
bwang 0:54cf32d35f4d 30 }