@chrisknightley , yes because it seems when I fixed the include in the sketch:
#include <EEPROM.h>
#include <Servo.h>
#include "TeensyServo.h"
#include "configuration.h"
#include <ros.h>
#include <MotorCommand.h>
#include <MotorParameter.h>
#include <inmoov_msgs/MotorStatus.h>
#include <std_srvs/Empty.h>
I get the WProgram.h error back again when I try to upload to Mega..,
So does that mean a "python" compiler is required to be installed into Arduino IDE for it to compile this firmware properly? appreciate you!
it seems tweaking here and there, causes other problems arise..,