Draaiende motor op commando van knopje (WERKEND)
Dependencies: Encoder MODSERIAL mbed
Fork of P_controller_motor by
main.cpp
- Committer:
- ThomasBNL
- Date:
- 2015-09-17
- Revision:
- 2:f5c9d981de51
- Parent:
- 1:b0d3c64bd4d8
- Child:
- 3:eee8d5461256
File content as of revision 2:f5c9d981de51:
#include "mbed.h" #include "HIDScope.h" // Define the HIDScope and Ticker object HIDScope scope(1); Ticker scopeTimer; // Read the analog input float triangle_signal = 3; // The data read and send function void scopeSend() { scope.set(0,triangle_signal); scope.send(); } int main() { // Attach the data read and send function at 100 Hz scopeTimer.attach_us(&scopeSend, 1e4); while(1) { } } ////// P Motor Controller // Controller gain const double motorP_Kp=2.5; const double Convert_volt_to_position=0.00300; // Reusable P controller (FUNCTIE) double P (double error, const double Kp) { Return Kp*error; } // Error measurement and apply the output to the plant void motorP_Controller() { double reference_position = potmeter1.read(); double position = Convert_volt_to_position*encoder1.getPosition(); motorP=P(reference_position - position, motorP_Kp); } int main() { myControllerTicker.attach(&motorP_Controller,0.01f); //100Hz while(1){} }