JJ Dekker / Mbed 2 deprecated Totaleprogramma1

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.

Dependencies:   USBHost USBHostXpad mbed-rtos mbed

Fork of Totaleprogramma by jordy morsinkhof

Traxster.cpp

Committer:
juliandekker
Date:
2015-03-02
Revision:
1:da390b3b1330
Parent:
0:345f76c72b9a

File content as of revision 1:da390b3b1330:


#include "Traxster.h"
#include "utils.h"
#include "rtos.h"

//extern Serial pc;
//extern Mutex m;

int getMotorSpeedInt(float f){
    
    int max = 40;
    
    if(f > 1.0)
        f = 1.0;

    if(f < -1.0)
        f = -1.0;
    
    return   (int)round( (float)max * f );
}

void Traxster::SetMotors(float fm1, float fm2)
{
    int m1 = getMotorSpeedInt(fm1);
    int m2 = getMotorSpeedInt(fm2);
    
    //clear robot msgs
    while (rob.readable())
        rob.getc();
        
    if (m1 == 0 && m2 == 0)
    {
        rob.puts("stop\r");
    }
    else
    {
        //m.lock();
        //pc.printf("mogo 1:%d 2:%d\r\n", m1, m2);
        //m.unlock();
        rob.printf("mogo 1:%d 2:%d\r", m1, m2);
    }
    
    //clear robot msgs
    while (rob.readable())
        rob.getc();
}