Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
main.cpp
- Committer:
- uld
- Date:
- 2022-10-04
- Revision:
- 2:5369f34d061e
- Parent:
- 1:5431d59ee324
- Child:
- 4:803dc29393cc
File content as of revision 2:5369f34d061e:
#include "mbed.h" #include "m3pi.h" m3pi m3pi; // Minimum and maximum motor speeds #define MAX 1.0 #define MIN 0 // PID terms #define P_TERM 1 #define I_TERM 0 #define D_TERM 20 int main() { float a=m3pi.battery(); float b=m3pi.pot_voltage(); m3pi.locate(0,0); m3pi.cls(); m3pi.printf("%f.3 ",a); m3pi.locate(0,1); m3pi.printf("%f.3 ",b); // dette er en mega god kommentar 13:44 // denen er endnu bedre wait(2.0); m3pi.sensor_auto_calibrate(); float right; float left; float current_pos_of_line = 0.0; float previous_pos_of_line = 0.0; float derivative,proportional,integral = 0; float power; float speed = MAX; while (1) { // Get the position of the line. current_pos_of_line = m3pi.line_position(); proportional = current_pos_of_line; // Compute the derivative derivative = current_pos_of_line - previous_pos_of_line; // Compute the integral integral += proportional; // Remember the last position. previous_pos_of_line = current_pos_of_line; // Compute the power power = (proportional * (P_TERM) ) + (integral*(I_TERM)) + (derivative*(D_TERM)) ; // Compute new speeds right = speed+power; left = speed-power; // limit checks if (right < MIN) right = MIN; else if (right > MAX) right = MAX; if (left < MIN) left = MIN; else if (left > MAX) left = MAX; // set speed m3pi.left_motor(left); m3pi.right_motor(right); } }