Помогите разобраться с IMU6050(гироскоп,акселерометр)+Сервоприводы

Тема в разделе "Моторы, сервоприводы, робототехника", создана пользователем Antbot, 11 фев 2015.

  1. vvr

    vvr Инженерище

    во избежание дёрганий я на такую серву подаю 6 вольт (L7806) и на каждую серву через свой стабилизатор.
    7806 даёт 1 ампер, а серва столько и кушает.
     
  2. Antbot

    Antbot Нуб

    Да по одной координате вроде как всё гладко и радует глаз а вот две уже дерганий много...
    Хорошо, спасибо буду ждать решения с пояснением.
     
  3. Antbot

    Antbot Нуб

    Спасибо испробую сей метод...
     
  4. X-Dron

    X-Dron Гик

    Попробуй так
    Код (Text):
    #include <Servo.h>
    #include <Wire.h>
    #include <I2Cdev.h>
    #include <MPU6050.h>

    MPU6050 mpu;

    int16_t ax, ay, az;
    int16_t gx, gy, gz;

    Servo Xservo;
    Servo Yservo;

    int val;
    int prevVal_x, prevVal_y;

    void setup(){
        Wire.begin();
        Serial.begin(38400);

        mpu.initialize();

        Xservo.attach(9);
        Yservo.attach(10);
    }

    void loop(){
        mpu.getMotion6(&ax, &ay, &az, &gx, &gy, &gz);

        val = map(ax, -17000, 17000, 0, 179);
        if (val != prevVal_x){
            Xservo.write(val);
            prevVal_x = val;
        }  

        val = map(ay, -17000, 17000, 0, 179);
        if (val != prevVal_y){
            Yservo.write(val);
            prevVal_y = val;
        }
    delay(5);
    }
     
  5. Antbot

    Antbot Нуб

    Спасибо сейчас залью в ардуину
     
  6. vvr

    vvr Инженерище

    может надо
    val_x и val_y
     
  7. X-Dron

    X-Dron Гик

    не надо, val можно каждый раз рассчитывать заново на основе считанных показаний. Ее вообще можно сделать локальной, а вот хранить предыдущие состояния надо отдельно.
     
  8. Antbot

    Antbot Нуб

    Спасибо X-Dron вроде как чуть стабильнее стало и двигается более плавно но всё равно тремор, завтра куплю стабилизаторов по схеме всё распаяю, доработаю конструкцию и выложу видео работы
     
  9. Antbot

    Antbot Нуб

    vvr напиши а что даст val_x и val_y ?
     
  10. Antbot

    Antbot Нуб

    delay(5); - может задержку вообще в ноль сделать?