4WD Mobile Platform SKU:ROB0022

Transcription

1 4WD Mobile Platform SKU:ROB0022 Contents [hide] 1 Function Introduction 1.1 STEP1: Assemble Robot 1.2 STEP2: Debug Motor 1.3 STEP3:Install Upper Plate 1.4 STEP4: Debug Ultrasonic Sensor and Servo 1.5 STEP5: Debugging Robot Function Introduction This Kit will teach you how to build a automatic obstacle avoidance robot which is achieved on the platform of the Turtle Robot,based on ultrasonic sensor as distance measuring device,and combined with servo. STEP1: Assemble Robot 1.Assemble Your Own Motor Look in your parts bag for eight long screws. These are used to fix and secure the motors in place. Place the motors in the correct alignment, then screw them into place as shown in the picture below. Please note that washers and gaskets are also included in the parts bag. Washers can be used to increase friction, which helps fasten the motors into place. The gaskets help prevent the screw nuts from loosening and falling off due to the Pirate s movements and collisions. 1/24

2 2.Soldering the Cables Take the black and red wires out of the parts bag. Attach one black and one red cable (15 cm long) to each motor (4 motors in total). Then use your wire stripper to strip the insulation at both ends of the wires (make sure not to strip too much refer to the pictures below). Next, solder the wires onto the pins affixed to the motors. Repeat the soldering process for all four motors. 2/24

3 Note:Pay attention to the correct locations of the red and black wires when soldering. Please consult the following photos for details /24

4 3.Assemble the Romeo BLE controller Look in your parts bag for three copper supports. Those 1cm long supports are used to fasten the Romeo controller board. As shown in the picture below, there are three holes in the controller board. Place the three copper supports into the holes, then fasten them into place with the appropriate screws. 4/24

5 4.Assemble the Battery Box Take out two countersunk screws (their heads are flat). Then follow the steps shown in the picture below and affix the battery to the car base. 5/24

6 5.Crafting the Power Switch Batteries are the essential lifeblood of robots. To control power usage, we need to use a power switch: the switch turns off power when not in use, thus preserving electricity and battery life. Refer to the picture below before assembling and installing the power switch. Please pay attention to the sequence of the gaskets and screw nuts when assembling the switch. 6/24

7 After assembling the switch, we want to start soldering its wires. Take some of the remaining wire leftover from before. Strip the wiring off both ends of the cables so that the inside of the wire is exposed (same process as with the motors before). We want to solder the exposed end of the wires to the pins on the switch. When soldering, it s very important that we note the position of the switch s pins. Let s do this step by step. a)connect the switch to the battery charger. Pay attention to the exact location of both items. 7/24

8 b)solder the red cables connecting the switch with the battery charger as shown in the picture below. Here s another picture to make things clearer. 8/24

9 c)finally, take one red cable and one black cable. Attach one end of one cable to the negative pole of the battery charger and one end of the other cable to the positive pole of the battery charger. Then attach the other ends of both cables to the Romeo BLE controller. 9/24

10 10/24

11 Looking at this enlarged picture should give you a better idea of how the wires should be connected. After soldering, make sure to check and see if your wiring between the battery and Romeo controller is consistent from start to finish and matches with the above pictures. 6.Assemble the Car Base Using eight M3x6mm screws, attach the side plates to the front and back bumper plates as shown by the diagram below. Note: When tightening the screws during this step, make sure not to fully tighten the screws at first this way, we can easily detach the top board in later steps should we need to make adjustments. Then, re attach the base plate to the body of the car as shown in the picture below. 11/24

12 This is what the car base should like after it s been assembled remember to install the battery pack! 7.Connect the Motors with the Microcontroller Board Now we need to the motors with the microcontroller board. Carefully follow the following diagram: the left motor s red and black wires should be soldered into M2; the right motor s red and black wires should be soldered to M1. Pay special attention to the battery pack: the black wire should be soldered into the wire port reading GND, while the red wire should be soldered in the wire port labeled VND. Use your screwdriver to loosen and tighten the wire ports make sure these ports are fastened well once the wires have been inserted. Note: Make sure the wires from one motor (i.e. the left motor) are soldered into the motor port. (i.e. the M2 port on the diagram below do not solder one motor s wires into two separate ports.) 12/24

13 After soldering the motor wires to the microcontroller board, we re ready to attach the top plate to the base of the car. Before we attach the top plate, you have the option of attaching a sensor plate (see diagram below) if you don t plan to use sensors just yet, you can skip this extra step. 13/24

14 After attaching the top plate, your Pirate should resemble the picture below. 8.Attach an extra level to the Pirate Find the four holes on the base s top plate. Screw in the four M3x60mm Copper Standoffs, then attach the additional top plate as shown in the diagram below use M3x6mm screws to affix the plate to the copper standoffs. 14/24

15 Toss some wheels on your Pirate and you re ready to let it whip! 15/24

16 STEP2: Debug Motor Upload the Code int speedpin_m1 = 5; int speedpin_m2 = 6; int directionpin_m1 = 4; int directionpin_m2 = 7; //M1 Speed Control //M2 Speed Control //M1 Direction Control //M1 Direction Control void setup(){ void loop(){ caradvance(100,100); delay(1000); carback(100,100); delay(1000); carturnleft(250,250); delay(1000); carturnright(250,250); delay(1000); void carstop(){ // Motor Stop digitalwrite(speedpin_m2,0); digitalwrite(directionpin_m1,low); digitalwrite(speedpin_m1,0); digitalwrite(directionpin_m2,low); void carturnleft(int leftspeed,int rightspeed){ analogwrite (speedpin_m2,leftspeed); digitalwrite(directionpin_m1,high); analogwrite (speedpin_m1,rightspeed); //Turn Left //PWM Speed Control 16/24

17 digitalwrite(directionpin_m2,high); void carturnright(int leftspeed,int rightspeed){ analogwrite (speedpin_m2,leftspeed); digitalwrite(directionpin_m1,low); analogwrite (speedpin_m1,rightspeed); digitalwrite(directionpin_m2,low); void carback(int leftspeed,int rightspeed){ analogwrite (speedpin_m2,leftspeed); digitalwrite(directionpin_m1,low); analogwrite (speedpin_m1,rightspeed); digitalwrite(directionpin_m2,high); void caradvance(int leftspeed,int rightspeed){ analogwrite (speedpin_m2,leftspeed); digitalwrite(directionpin_m1,high); analogwrite (speedpin_m1,rightspeed); digitalwrite(directionpin_m2,low); //Turn Right //Move backward //Move forward STEP3:Install Upper Plate 1. Fixed Ultrasonic Sensor Position Please see the Installation Manual 2. Fixed Servo Position 17/24

18 STEP4: Debug Ultrasonic Sensor and Servo 1. Hardware Connection 18/24

19 2. Upload Code Download the library firstly.metro libray #include <Servo.h> #include <Metro.h> Metro measuredistance = Metro(50); Metro sweepservo = Metro(20); unsigned long actualdistance = 0; Servo myservo; // create servo object to control a servo int pos = 60; int sweepflag = 1; 19/24

20 int URPWM = 3; // PWM Output US,Every 50US represent 1cm int URTRIG= 10; // PWM trigger pin uint8_t EnPwmCmd[4]={0x44,0x02,0xbb,0x01; // distance measure command void setup(){ // Serial initialization myservo.attach(9); Serial.begin(9600); // Sets the baud rate to 9600 SensorSetup(); void loop(){ if(measuredistance.check() == 1){ actualdistance = MeasureDistance(); // Serial.println(actualDistance); // delay(100); if(sweepservo.check() == 1){ servosweep(); void SensorSetup(){ pinmode(urtrig,output); digitalwrite(urtrig,high); pinmode(urpwm, INPUT); for(int i=0;i<4;i++){ Serial.write(EnPwmCmd[i]); // A low pull on pin COMP/TRIG // Set to HIGH // Sending Enable PWM mode command int MeasureDistance(){ // a low pull on pin COMP/TRIG triggering a sensor reading digitalwrite(urtrig, LOW); digitalwrite(urtrig, HIGH); // reading Pin PWM will output pulses unsigned long distance=pulsein(urpwm,low); if(distance==50000){ // the reading is invalid. Serial.print("Invalid"); else{ distance=distance/50; // every 50us low level stands for 1cm return distance; void servosweep(){ if(sweepflag ){ if(pos>=60 && pos<=120){ pos=pos+1; myservo.write(pos); if(pos>119) sweepflag = false; else { if(pos>=60 && pos<=120){ pos=pos 1; myservo.write(pos); if(pos<61) sweepflag = true; // in steps of 1 degree // tell servo to go to position in variable 'pos' // assign the variable again 20/24

21 3. Adjust the servo position Method 1: Reinstall wheel Method 2: Adapt your code accordingly STEP5: Debugging Robot 1. Fix the expansion board Uplpad the code #include <Servo.h> #include <Metro.h> Metro measuredistance = Metro(50); Metro sweepservo = Metro(20); int speedpin_m1 = 5; //M1 Speed Control int speedpin_m2 = 6; //M2 Speed Control int directionpin_m1 = 4; //M1 Direction Control int directionpin_m2 = 7; //M1 Direction Control unsigned long actualdistance = 0; Servo myservo; // create servo object to control a servo int pos = 60; int sweepflag = 1; int URPWM = 3; // PWM Output US,Every 50US represent 1cm 21/24

22 int URTRIG= 10; // PWM trigger pin uint8_t EnPwmCmd[4]={0x44,0x02,0xbb,0x01; // distance measure command void setup(){ // Serial initialization myservo.attach(9); Serial.begin(9600); // Sets the baud rate to 9600 SensorSetup(); void loop(){ if(measuredistance.check() == 1){ actualdistance = MeasureDistance(); // Serial.println(actualDistance); // delay(100); if(sweepservo.check() == 1){ servosweep(); if(actualdistance <= 30){ myservo.write(90); if(pos>=90){ // carback(100,100); //// Serial.println("carBack"); // delay(100); carturnright(150,150); // Serial.println("carTurnRight"); delay(100); else{ // carback(100,100); //// Serial.println("carBack"); // delay(100); carturnleft(150,150); // Serial.println("carTurnLeft"); delay(100); else{ caradvance(70,70); // Serial.println("carAdvance"); delay(100); // carback(150,150); void SensorSetup(){ pinmode(urtrig,output); digitalwrite(urtrig,high); pinmode(urpwm, INPUT); for(int i=0;i<4;i++){ Serial.write(EnPwmCmd[i]); // A low pull on pin COMP/TRIG // Set to HIGH // Sending Enable PWM mode command int MeasureDistance(){ // a low pull on pin COMP/TRIG triggering a sensor reading digitalwrite(urtrig, LOW); digitalwrite(urtrig, HIGH); // reading Pin PWM will output pulses unsigned long distance=pulsein(urpwm,low); 22/24

23 if(distance==50000){ Serial.print("Invalid"); else{ distance=distance/50; return distance; void carstop(){ // Motor Stop digitalwrite(speedpin_m2,0); digitalwrite(directionpin_m1,low); digitalwrite(speedpin_m1,0); digitalwrite(directionpin_m2,low); // the reading is invalid. // every 50us low level stands for 1cm void carturnleft(int leftspeed,int rightspeed){ analogwrite (speedpin_m2,leftspeed); digitalwrite(directionpin_m1,high); analogwrite (speedpin_m1,rightspeed); digitalwrite(directionpin_m2,high); void carturnright(int leftspeed,int rightspeed){ analogwrite (speedpin_m2,leftspeed); digitalwrite(directionpin_m1,low); analogwrite (speedpin_m1,rightspeed); digitalwrite(directionpin_m2,low); void carback(int leftspeed,int rightspeed){ analogwrite (speedpin_m2,leftspeed); digitalwrite(directionpin_m1,low); analogwrite (speedpin_m1,rightspeed); digitalwrite(directionpin_m2,high); void caradvance(int leftspeed,int rightspeed){ analogwrite (speedpin_m2,leftspeed); digitalwrite(directionpin_m1,high); analogwrite (speedpin_m1,rightspeed); digitalwrite(directionpin_m2,low); void servosweep(){ if(sweepflag){ if(pos>=60 && pos<=120){ pos=pos+1; myservo.write(pos); if(pos>119) sweepflag = false; else { if(pos>=60 && pos<=120){ pos=pos 1; myservo.write(pos); if(pos<61) sweepflag = true; //Turn Left //PWM Speed Control //Turn Right //Move backward //Move forward // in steps of 1 degree // tell servo to go to position in variable 'pos' // assign the variable again 23/24

24 Your own car was born! 24/24