Motor calibration

Dependencies:   BioroboticsMotorControl mbed BioroboticsEMGFilter MODSERIAL

main.cpp

Committer:
MAHCSnijders
Date:
2018-10-31
Revision:
0:61f4586742be
Child:
1:9c75e4cca419

File content as of revision 0:61f4586742be:

#include "mbed.h"

Motor motor1(D6, D7, D13, D12);             // Defining motor pins (PWM, direction, encoder)
Motor motor2(D5, D4, D10, D11);             // Defining motor pins (PWM, direction, encoder)

const double Kp = 10.0;
const double Ki = 0.1;
const double Kd = 0.5;

Ticker motor_cali;

void Motor_Calibration()
{
    float motor_angle1 = motor1.get_current_angle;
    motor_angle1--;
    motor1.set_target_angle(motor_angle1);   
    
    float motor_angle2 = motor2.get_current_angle;
    motor_angle2--;
    motor2.set_target_angle(motor_angle2);
}

int main()
{
    motor1.set_pid_k_values(Kp, Ki, Kd);    // Attach PID-controller
    motor2.set_pid_k_values(Kp, Ki, Kd);
    motor1.start(pid_period)                // Attach PID time
    motor2.start(pid_period);
    motor.attach(Motor_Calibration,0.5);    // Ticker for motor calibration fucntion
    while (true) {}                         // Empty while loop to keep function from stopping
}