Arduino mega 2560 платформа на гусенецах и мотор шилд V2.0

Приветствую. Помогите советом!!!
Не могу заставить моторчики крутится. В планах через роутер управлять платформой. Но пока стопор с моторами.
Вот такая платформа

Вот такой шилд

Шилд просто вставлен в ардуину и залит тестовый скетч

Код (Text):

// Adafruit Motor shield library
// copyright Adafruit Industries LLC, 2009
// this code is public domain, enjoy!

#include <AFMotor.h>

AF_DCMotor motor(4);

void setup() {
  Serial.begin(9600);          // set up Serial library at 9600 bps
  Serial.println("Motor test!");

  // turn on motor
  motor.setSpeed(200);
  motor.run(RELEASE);
}

void loop() {
  uint8_t i;
 
  Serial.print("tick");
 
  motor.run(FORWARD);
  for (i=0; i<255; i++) {
    motor.setSpeed(i);
    delay(10);
}
  for (i=255; i!=0; i--) {
    motor.setSpeed(i);
    delay(10);
}
 
  Serial.print("tock");

  motor.run(BACKWARD);
  for (i=0; i<255; i++) {
    motor.setSpeed(i);
    delay(10);
}
  for (i=255; i!=0; i--) {
    motor.setSpeed(i);
    delay(10);
}
 

  Serial.print("tech");
  motor.run(RELEASE);
  delay(1000);
}

Питание осуществляется от аккумуляторов. Один аккумулятор питает ардуино, второй через шилд моторы.
Заранее спасибо

 

Вот таким способом все соединено.


Питание пока что сделал общим переставив перемычку на шилде. Подключил тестовый скетч LMotorShield и сразу все заработало. Теперь надо подключить роутер и камеру

 

В общем поставил другой Motor Shild. Так как этот нормально работать не хочет.
При тестовом скетче все нормально, платформа двигается.
Соеденил модуль блютус и Motor Shild с arduino, добавив ультразвуковой датчик. Теперь выпадает ошибка

Код (Text):

In file included from sketch_nov28b.ino:3:
C:\arduino-1.0.2\libraries\SoftwareSerial/SoftwareSerial.h:52: error: conflicting return type specified for 'virtual void SoftwareSerial::write(uint8_t)'
C:\arduino-1.0.2\hardware\arduino\cores\arduino/Print.h:48: error:  overriding 'virtual size_t Print::write(uint8_t)'

Не подскажите почему ругается ? я понимаю что на библиотеку SoftwareSerial.