Skip to content
Snippets Groups Projects
Commit 5c0af070 authored by Zhaoliang Zheng's avatar Zhaoliang Zheng
Browse files

Auto stash before merge of "main" and "origin/main"

parent a859bcf4
No related merge requests found
// Motor Test Code - Aaron // Motor Basic Test Code - Aaron
#include <Wire.h> #include <Wire.h>
#include <Adafruit_MotorShield.h> #include <Adafruit_MotorShield.h>
...@@ -11,37 +11,75 @@ Adafruit_DCMotor *motorVL = AFMS.getMotor(1); ...@@ -11,37 +11,75 @@ Adafruit_DCMotor *motorVL = AFMS.getMotor(1);
Adafruit_DCMotor *motorVR = AFMS.getMotor(2); Adafruit_DCMotor *motorVR = AFMS.getMotor(2);
Adafruit_DCMotor *motorHL = AFMS.getMotor(3); Adafruit_DCMotor *motorHL = AFMS.getMotor(3);
Adafruit_DCMotor *motorHR = AFMS.getMotor(4); Adafruit_DCMotor *motorHR = AFMS.getMotor(4);
void setup() { void setup() {
Serial.begin(115200);
AFMS.begin(); AFMS.begin();
} }
void loop() { void loop() {
Serial.println("-- START LOOP ---");
Serial.println();
Serial.println(" Vertical Left - Forward Fast");
motorHR->setSpeed(0); motorHR->setSpeed(0);
motorVL->setSpeed(largeVal); motorVL->setSpeed(largeVal);
motorVL->run(FORWARD); motorVL->run(FORWARD);
delay(5000); delay(2000);
<<<<<<< Updated upstream
Serial.println(" Vertical Left - Backward Slow");
motorVL->setSpeed(smallVal);
motorVL->run(BACKWARD);
delay(2000);
Serial.println(" Vertical Right - Forward Fast");
=======
motorVL->setSpeed(smallVal); motorVL->setSpeed(smallVal);
motorVL->run(BACKWARD); motorVL->run(BACKWARD);
delay(5000); delay(2000);
>>>>>>> Stashed changes
motorVL->setSpeed(0); motorVL->setSpeed(0);
motorVR->setSpeed(largeVal); motorVR->setSpeed(largeVal);
motorVR->run(FORWARD); motorVR->run(FORWARD);
delay(5000); delay(2000);
<<<<<<< Updated upstream
Serial.println(" Vertical Right - Backward Slow");
motorVR->setSpeed(smallVal);
motorVR->run(BACKWARD);
delay(2000);
Serial.println(" Horizontal Left - Forward Fast");
=======
motorVR->setSpeed(smallVal); motorVR->setSpeed(smallVal);
motorVR->run(BACKWARD); motorVR->run(BACKWARD);
delay(5000); delay(2000);
>>>>>>> Stashed changes
motorVR->setSpeed(0); motorVR->setSpeed(0);
motorHL->setSpeed(largeVal); motorHL->setSpeed(largeVal);
motorHL->run(FORWARD); motorHL->run(FORWARD);
delay(5000); delay(2000);
<<<<<<< Updated upstream
Serial.println(" Horizontal Left - Backward Slow");
motorHL->setSpeed(smallVal); motorHL->setSpeed(smallVal);
motorHL->run(BACKWARD); motorHL->run(BACKWARD);
delay(5000); delay(2000);
Serial.println(" Horizontal Right - Forward Fast");
=======
motorHL->setSpeed(smallVal);
motorHL->run(BACKWARD);
delay(2000);
>>>>>>> Stashed changes
motorHL->setSpeed(0); motorHL->setSpeed(0);
motorHR->setSpeed(largeVal); motorHR->setSpeed(largeVal);
motorHR->run(FORWARD); motorHR->run(FORWARD);
delay(5000); delay(2000);
<<<<<<< Updated upstream
Serial.println(" Horizontal Right - Backward Slow");
motorHR->setSpeed(smallVal);
motorHR->run(BACKWARD);
delay(2000);
Serial.println();
Serial.println();
=======
motorHR->setSpeed(smallVal); motorHR->setSpeed(smallVal);
motorHR->run(BACKWARD); motorHR->run(BACKWARD);
delay(5000); delay(2000);
>>>>>>> Stashed changes
} }
...@@ -11,8 +11,8 @@ ...@@ -11,8 +11,8 @@
// MAC Address of the receiver (MASTER) // MAC Address of the receiver (MASTER)
//uint8_t broadcastAddress[] = {0xC4, 0xDD, 0x57, 0x9E, 0x91, 0x74}; // #1 //uint8_t broadcastAddress[] = {0xC4, 0xDD, 0x57, 0x9E, 0x91, 0x74}; // #1
//uint8_t broadcastAddress[] = {0x40, 0xF5, 0x20, 0x44, 0xBD, 0xF8}; // #2 //uint8_t broadcastAddress[] = {0x40, 0xF5, 0x20, 0x44, 0xBD, 0xF8}; // #2
//uint8_t broadcastAddress[] = {0xC4, 0xDD, 0x57, 0x9E, 0x8A, 0x98}; // #3 uint8_t broadcastAddress[] = {0xC4, 0xDD, 0x57, 0x9E, 0x8A, 0x98}; // #3
uint8_t broadcastAddress[] = {0x40, 0xF5, 0x20, 0x44, 0xB6, 0x4C}; // #4 // uint8_t broadcastAddress[] = {0x40, 0xF5, 0x20, 0x44, 0xB6, 0x4C}; // #4
String success; String success;
// Define variables to store incoming readings // Define variables to store incoming readings
...@@ -108,7 +108,7 @@ void OnDataRecv(const uint8_t * mac, const uint8_t *incomingData, int len) { ...@@ -108,7 +108,7 @@ void OnDataRecv(const uint8_t * mac, const uint8_t *incomingData, int len) {
count = 0; count = 0;
print_count=0; print_count=0;
change_count = 0; change_count = 0;
control_motion(); // control_motion();
} }
// =============================== All the setup =========================================== // =============================== All the setup ===========================================
...@@ -228,7 +228,7 @@ void loop() ...@@ -228,7 +228,7 @@ void loop()
print_received_Data(); print_received_Data();
//------------------------------------------------------------------------------------- //-------------------------------------------------------------------------------------
// control_motion(); control_motion();
//------------------------------------------------------------------------------------- //-------------------------------------------------------------------------------------
} }
// ================================== ^ Main loop ^ =================================================== // ================================== ^ Main loop ^ ===================================================
......
...@@ -5,9 +5,11 @@ ...@@ -5,9 +5,11 @@
// ==================================== broadcast address ============================================ // ==================================== broadcast address ============================================
// MAC Address of the receiver (SLAVE) // MAC Address of the receiver (SLAVE)
//uint8_t broadcastAddress[] = {0xC4, 0xDD, 0x57, 0x9E, 0x91, 0x74}; // #1 //uint8_t broadcastAddress[] = {0xC4, 0xDD, 0x57, 0x9E, 0x91, 0x74}; // #1
uint8_t broadcastAddress[] = {0x40, 0xF5, 0x20, 0x44, 0xBD, 0xF8}; // #2 // uint8_t broadcastAddress[] = {0x40, 0xF5, 0x20, 0x44, 0xBD, 0xF8}; // #2
//uint8_t broadcastAddress[] = {0xC4, 0xDD, 0x57, 0x9E, 0x8A, 0x98}; // #3 //uint8_t broadcastAddress[] = {0xC4, 0xDD, 0x57, 0x9E, 0x8A, 0x98}; // #3
//uint8_t broadcastAddress[] = {0x40, 0xF5, 0x20, 0x44, 0xB6, 0x4C}; // #4 //uint8_t broadcastAddress[] = {0x40, 0xF5, 0x20, 0x44, 0xB6, 0x4C}; // #4
// uint8_t broadcastAddress[] = {0x40, 0xF5, 0x20, 0x44, 0xC0, 0xD8}; // #5
uint8_t broadcastAddress[] = {0x40, 0xF5, 0x20, 0x44, 0xDE, 0xE0}; // #6
// ==================================== global data ================================================= // ==================================== global data =================================================
String success; String success;
// Define variables to store BME280 readings to be sent // Define variables to store BME280 readings to be sent
......
...@@ -407,7 +407,12 @@ def manual_control(Ctl_com,serial_port): ...@@ -407,7 +407,12 @@ def manual_control(Ctl_com,serial_port):
def dynamic_variable(str_name_v): def dynamic_variable(str_name_v):
global kpx,kix,kdx,start_speed global start_speed
global kpx,kix,kdx
global kpy,kiy,kdy
global kpx_g,kix_g,kdx_g
global kpy_g,kiy_g,kdy_g
if str_name_v == "kpx": if str_name_v == "kpx":
kpx = input("Enter your value: ") kpx = input("Enter your value: ")
print("kpx:{}".format(kpx)) print("kpx:{}".format(kpx))
...@@ -420,6 +425,33 @@ def dynamic_variable(str_name_v): ...@@ -420,6 +425,33 @@ def dynamic_variable(str_name_v):
elif str_name_v == "stsp": elif str_name_v == "stsp":
start_speed = input("Enter your value: ") start_speed = input("Enter your value: ")
print("start_speed:{}".format(start_speed)) print("start_speed:{}".format(start_speed))
elif str_name_v == "kpy":
kpx = input("Enter your value: ")
print("kpy:{}".format(kpy))
elif str_name_v == "kiy":
kix = input("Enter your value: ")
print("kiy:{}".format(kiy))
elif str_name_v == "kdy":
kdx = input("Enter your value: ")
print("kdy:{}".format(kdy))
if str_name_v == "kpx":
kpx = input("Enter your value: ")
print("kpx:{}".format(kpx))
elif str_name_v == "kix_g":
kix = input("Enter your value: ")
print("kix_g:{}".format(kix_g))
elif str_name_v == "kdx":
kdx = input("Enter your value: ")
print("kdx_g:{}".format(kdx_g))
elif str_name_v == "kpy_g":
kpx = input("Enter your value: ")
print("kpy_g:{}".format(kpy_g))
elif str_name_v == "kiy_g":
kix = input("Enter your value: ")
print("kiy_g:{}".format(kiy_g))
elif str_name_v == "kdy_g":
kdx = input("Enter your value: ")
print("kdy_g:{}".format(kdy_g))
def variables_change_once(): def variables_change_once():
...@@ -504,6 +536,3 @@ if __name__ == '__main__': ...@@ -504,6 +536,3 @@ if __name__ == '__main__':
if print_count is not 0: if print_count is not 0:
print("No subsystem is running") print("No subsystem is running")
print_count = 0 print_count = 0
...@@ -41,8 +41,7 @@ void motor_control(int pwm1,int pwm2,int pwm3,int pwm4){ ...@@ -41,8 +41,7 @@ void motor_control(int pwm1,int pwm2,int pwm3,int pwm4){
void loop() { void loop() {
// put your main code here, to run repeatedly: // put your main code here, to run repeatedly:
int t_speed = 50; int t_speed = 50;
motorVertical_L->setSpeed(t_speed); motorVertical_L->setSpeed(t_speed);
motorVertical_R->setSpeed(t_speed); motorVertical_R->setSpeed(t_speed);
......
0% or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment