MOTION SIMULATOR WITH ARDUINO MEGA 2560

davidlbraga · Apr 23, 2013

I would like to set up a project with 2 motors for arduino, but I'm inexperienced and would like to make something from scratch to understand how it works and help improve the X-sim in the future.

what should I do? Someone is willing to help build from scratch?

I working a platform with a board arduino mega 2560 and 2 servo motors for testing, but I'm starting from the beginning.

hardware

eaorobbie · May 12, 2013

What do you need to know,
Im willing to share my RC Sim Model mate.

http://www.youtube.com/watch?v=NlaCMZPgbh0

Proof of my working unit, beware profile running it is very basic.

eaorobbie · May 13, 2013

/* 2DOF Arduino Servos For X-SIM
written by EaoRobbie.
USO command is L~a01~R~a02~
Set Baud to 9600,8,noparity,onestopbit
*/

#include <Servo.h>

Servo myservo1; //Name for Left Servo
Servo myservo2; //Name for Right Servo

int DegreeLS; //Degree measurement for Left Servo (0-180)
int DegreeRS; //Degree measurement for Right Servo (0-180)

int Gforce = 0; //Gforce Xsim is sending.
int Gforce1 = 0; //Gforce breakdown ie 123 is 3
int Gforce10 = 0; //Gforce breakdown ie 123 is 2
int Gforce100 = 0; //Gforce breakdown ie 123 is 1

char kind_of_data; //The char sent from Xsim ie L or R

void setup() {

//set servo pins
myservo1.attach(5); //Wire for signal on Left Servo
myservo2.attach(6); //Wire for signal on Right Servo

//align servos center postision
myservo1.write(90); // Centre Left Servo
myservo2.write(90); // Centre Right Servo

//open serial connection
Serial.begin(9600);
}

void loop() {
while (Serial.available() > 0)
{
//Lets read the first char
kind_of_data = Serial.read();
if (kind_of_data == 'L' ) Read_LeftServoPos(); // Ok data is for Left Servo
if (kind_of_data == 'R') Read_RightServoPos(); // Ok data is for Right Servo
}}

//To read the Left Servos Gforce and change it to a degree
//Move the servo to that Degree.
void Read_LeftServoPos(){
Gforce=0; //Just to be sure Gforce is clear.
delay(2);
Gforce100 = Serial.read()-48; // Read the 100's digit
delay(2);
Gforce10 = Serial.read()-48; // Read the 10's digit
delay(2);
Gforce1= Serial.read()-48; // Read the 1's digit

//Serial.println(Gforce100); //These are here for degugging in the Serial Moniter
//Serial.println(Gforce10); // in the Ardunio before you connect to XSIM.
// Serial.println(Gforce1);

Gforce100 = (Gforce100)*100; //Turn digit into it real value ie 1 - 100
Gforce10 = (Gforce10)*10; //Turn digit into it real value ie 2 - 20
Gforce1 = (Gforce1)*1; //Turn digit into it real value ie 3 - 3

if (Gforce10 < 0 && Gforce1 < 0){ //This is to check if any values are
Gforce100 = Gforce100/100; // negative as this effects the outcome
Gforce10 = 0; // in debugging you will see what I mean.
Gforce1 = 0;
}

if (Gforce1 < 0){
Gforce100 = Gforce100/10;
Gforce10 = Gforce10/10;
Gforce1 = 0;
}
Gforce = Gforce100+Gforce10+Gforce1; //Now happy with them lets add them together
// IE 1,2,3 - 100,20,3 - 123.

// Serial.println(kind_of_data); //This is for debuging.
//Serial.println(Gforce);
DegreeLS = map(Gforce, 0, 255, 1, 179); //Set degree for Left Servo
//Serial.println(DegreeLS);
myservo1.write(DegreeLS); //Move Left Servo and loop back.
}

//To read the Right Servos Gforce and change it to a degree
//Move the servo to that Degree.
void Read_RightServoPos(){
Gforce=0;
delay(2);
Gforce100 = Serial.read()-48;
delay(2);
Gforce10 = Serial.read()-48;
delay(2);
Gforce1= Serial.read()-48;

//Serial.println(Gforce100);
//Serial.println(Gforce10);
//Serial.println(Gforce1);

Gforce100 = (Gforce100)*100;
Gforce10 = (Gforce10)*10;
Gforce1 = (Gforce1)*1;

if (Gforce10 < 0 && Gforce1 < 0){
Gforce100 = Gforce100/100;
Gforce10 = 0;
Gforce1 = 0;
}

if (Gforce1 < 0){
Gforce100 = Gforce100/10;
Gforce10 = Gforce10/10;
Gforce1 = 0;
}
Gforce = Gforce100+Gforce10+Gforce1;

// Serial.println(kind_of_data);
//Serial.println(Gforce);
DegreeRS = map(Gforce, 0, 255, 179, 1);
//Serial.println(DegreeRS);
myservo2.write(DegreeRS);
}
Click to expand...

And the working code this should run on your card too, from what I can work out.

RaceRay · May 13, 2013

Great! I own a Arduino Leonardo board, so i will implement your code for educating purposes I wished the larger servos able to move a humans butt would be affordable the same as the small RC ones. RC servos are sooo fast.

eaorobbie · May 13, 2013

Raceray said:

Great! I own a Arduino Leonardo board, so i will implement your code for educating purposes I wished the larger servos able to move a humans butt would be affordable the same as the small RC ones. RC servos are sooo fast.
Click to expand...

Well I'm actually in the middle of working out the ins and outs for a new card that has come to the market recently, Its RC compatible meaning we can drive it with the simple code above and it will drive its sister h bridge just like a servo does not sure on how fast until the rest of the parts show up , I can not test yet.
Some features in clue auto tuning of its own pid, with addition of limit switch it has its own calibration routine plus they also act as safety switches too not letting your motor get out of control, encoder compatable of the shelf item, no electronic building, as simpler than the JRK, to name a few.
I have also been informed from makers that it can be used with serial to usb adapter and we can communicate to it without the Ard.
So as I know more I will release the info in separate post for all to read and use.
Looks very promising, as is priced very fairly.
Just to add it runs on 12v or 24v mmmmm finally a simple 24v system.

dualclick · Dec 4, 2014

Volevo una informazione ho acquistato uno dei vostri leonardo Arduino Arduino rev 3, ma invece mi hanno mandato, volevo sapere se le configurazioni sono simili al Arduino rev 3

Log in or Sign up

MOTION SIMULATOR WITH ARDUINO MEGA 2560

davidlbraga New Member

eaorobbie Well-Known Member SimTools Developer Gold Contributor

eaorobbie Well-Known Member SimTools Developer Gold Contributor

RaceRay Administrator Staff Member SimAxe Beta Tester

eaorobbie Well-Known Member SimTools Developer Gold Contributor

dualclick