Lagað sameinaða kóða eftir merge. Muna fokkin kommur!!
This commit is contained in:
@@ -18,9 +18,9 @@ private:
|
|||||||
|
|
||||||
State* current_state;
|
State* current_state;
|
||||||
|
|
||||||
State* initialization_state;
|
State& initialization_state;
|
||||||
State* operational_state;
|
State& operational_state;
|
||||||
State* stopped_state;
|
State& stopped_state;
|
||||||
|
|
||||||
RotaryEncoderDriver& encoder;
|
RotaryEncoderDriver& encoder;
|
||||||
MotorDriver& motor;
|
MotorDriver& motor;
|
||||||
@@ -35,15 +35,18 @@ public:
|
|||||||
MotorController(
|
MotorController(
|
||||||
RotaryEncoderDriver& encoder,
|
RotaryEncoderDriver& encoder,
|
||||||
MotorDriver& motor,
|
MotorDriver& motor,
|
||||||
P_controller& controller
|
P_controller& controller,
|
||||||
|
State& initialization,
|
||||||
|
State& operational,
|
||||||
|
State& stopped
|
||||||
);
|
);
|
||||||
|
|
||||||
|
|
||||||
void set_states(
|
// void set_states(
|
||||||
State* initialization,
|
// State* initialization,
|
||||||
State* operational,
|
// State* operational,
|
||||||
State* stopped
|
// State* stopped
|
||||||
);
|
// );
|
||||||
|
|
||||||
|
|
||||||
void begin();
|
void begin();
|
||||||
|
|||||||
+7
-6
@@ -33,7 +33,8 @@ MotorController motor_controller(
|
|||||||
motor,
|
motor,
|
||||||
controller,
|
controller,
|
||||||
initialization_state,
|
initialization_state,
|
||||||
operational_state
|
operational_state,
|
||||||
|
stopped_state
|
||||||
);
|
);
|
||||||
|
|
||||||
|
|
||||||
@@ -53,11 +54,11 @@ int main()
|
|||||||
sei();
|
sei();
|
||||||
|
|
||||||
|
|
||||||
motor_controller.set_states(
|
// motor_controller.set_states(
|
||||||
&initialization_state,
|
// &initialization_state,
|
||||||
&operational_state,
|
// &operational_state,
|
||||||
&stopped_state
|
// &stopped_state
|
||||||
);
|
// );
|
||||||
|
|
||||||
|
|
||||||
motor_controller.begin();
|
motor_controller.begin();
|
||||||
|
|||||||
+26
-24
@@ -9,33 +9,35 @@ MotorController::MotorController(
|
|||||||
MotorDriver& motor,
|
MotorDriver& motor,
|
||||||
P_controller& controller,
|
P_controller& controller,
|
||||||
State& initialization,
|
State& initialization,
|
||||||
State& operational
|
State& operational,
|
||||||
|
State& stopped
|
||||||
)
|
)
|
||||||
: current_state(nullptr),
|
: current_state(nullptr),
|
||||||
initialization_state(nullptr),
|
initialization_state(initialization),
|
||||||
operational_state(nullptr),
|
operational_state(operational),
|
||||||
stopped_state(nullptr),
|
stopped_state(stopped),
|
||||||
encoder(encoder),
|
encoder(encoder),
|
||||||
motor(motor),
|
motor(motor),
|
||||||
controller(controller),
|
controller(controller),
|
||||||
led(LED_PIN),
|
led(LED_PIN),
|
||||||
reference_rpm(DEFAULT_REFERENCE_RPM)
|
reference_rpm(DEFAULT_REFERENCE_RPM)
|
||||||
{
|
{
|
||||||
|
initialization_state.set_context(this);
|
||||||
|
operational_state.set_context(this);
|
||||||
|
stopped_state.set_context(this);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
void MotorController::set_states(
|
// void MotorController::set_states(
|
||||||
State* initialization,
|
// State* initialization,
|
||||||
State* operational,
|
// State* operational,
|
||||||
State* stopped
|
// State* stopped
|
||||||
)
|
// )
|
||||||
{
|
|
||||||
initialization_state = initialization;
|
// initialization_state = initialization;
|
||||||
operational_state = operational;
|
// operational_state = operational;
|
||||||
stopped_state = stopped;
|
// stopped_state = stopped;
|
||||||
//initialization_state.set_context(this);
|
|
||||||
//operational_state.set_context(this);
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
void MotorController::begin()
|
void MotorController::begin()
|
||||||
@@ -128,13 +130,13 @@ bool MotorController::fault_active()
|
|||||||
return motor.fault_active();
|
return motor.fault_active();
|
||||||
}
|
}
|
||||||
|
|
||||||
//void MotorController::led_on()
|
void MotorController::led_on()
|
||||||
//{
|
{
|
||||||
// led.set_hi();
|
led.set_hi();
|
||||||
//}
|
}
|
||||||
|
|
||||||
|
|
||||||
//void MotorController::led_off()
|
void MotorController::led_off()
|
||||||
//{
|
{
|
||||||
// led.set_lo();
|
led.set_lo();
|
||||||
//}
|
}
|
||||||
|
|||||||
@@ -126,5 +126,5 @@ void MotorDriver::set(double pwm)
|
|||||||
|
|
||||||
bool MotorDriver::fault_active()
|
bool MotorDriver::fault_active()
|
||||||
{
|
{
|
||||||
return !(PIND & (1 << PIND4));p
|
return !(PIND & (1 << PIND4));
|
||||||
}
|
}
|
||||||
|
|||||||
Reference in New Issue
Block a user