RobotikaBrno - RBControl

Add a new message

Title

Text

main.cpp
[code]
#include <Arduino.h>
#include "RBControl_manager.hpp"
#include <Servo.h>

rb::Manager& rbc() 
{
    static rb::Manager m(false);  // ve výchozím stavu se motory po puštění tlačítka vypínají, false zařídí, že pojedou, dokud nedostanou další pokyn 
    return m;
}

Servo servo;

void setup() {
    Serial.begin(115200);
    servo.attach(25);
    servo.write(90);
}

#define LEFT_MOTOR  rb::MotorId::M1
#define RIGHT_MOTOR  rb::MotorId::M2

void loop() {
    if(Serial.available()) {
        char c = Serial.read();
        switch(c) {
            case 'w':
                man->setMotors().power(LEFT_MOTOR, 32)
                                .power(RIGHT_MOTOR, 32)
                                .set();
                break;
            case 's':
                man->setMotors().power(LEFT_MOTOR, -32)
                                .power(RIGHT_MOTOR, -32)
                                .set();
                break;
            case 'a':
                man->setMotors().power(LEFT_MOTOR, -32)
                                .power(RIGHT_MOTOR, 32)
                                .set();
                break;
            case 'd':
                man->setMotors().power(LEFT_MOTOR, 32)
                                .power(RIGHT_MOTOR, -32)
                                .set();
                break;
            case ' ':
                man->setMotors().power(LEFT_MOTOR, 0)
                                .power(RIGHT_MOTOR, 0)
                                .set();
                break;
            case 'q':
                servo.write(60);
                break;
            case 'e':
                servo.write(120);
                break;
            default:
                Serial.write(c);
                break;
        }
    }
}

[/code]

Password