bionic (unfinished)
This commit is contained in:
@@ -22,13 +22,28 @@ void FollowerClass::plane(global_location target_location,global_location leader
|
||||
c = target_location.lat - slope*target_location.lon;
|
||||
y = slope * follower_location.lon + c;
|
||||
|
||||
// if()
|
||||
if(follower_location.lat >= y){
|
||||
drone1.plane = 1; //right plane
|
||||
}else if(follower_location.lat < y){
|
||||
drone1.plane = 0; //left plane
|
||||
}
|
||||
|
||||
//choose_leader()
|
||||
choose_leader();
|
||||
}
|
||||
|
||||
void FollowerClass::choose_leader(){
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
}
|
||||
|
||||
void FollowerClass::get_location(){
|
||||
|
||||
// lon[0]
|
||||
|
||||
|
||||
}
|
||||
|
||||
void FollowerClass::calculate_position(float k,float theta){
|
||||
|
||||
@@ -1,5 +1,5 @@
|
||||
MQTT:
|
||||
msg_format: Proto
|
||||
msg_format: Json
|
||||
MQTTClientNamePub: Drone550Pub
|
||||
host: 140.120.31.133
|
||||
port: 1883
|
||||
|
||||
@@ -1,5 +1,5 @@
|
||||
MQTT:
|
||||
msg_format: Proto
|
||||
msg_format: Json
|
||||
MQTTClientNameSub: Drone550Sub
|
||||
host: 140.120.31.133
|
||||
port: 1883
|
||||
|
||||
Reference in New Issue
Block a user