#include "kinematics_exchanger.h"
Go to the source code of this file.
Functions | |
float | acc_cos (float x, float y) |
Accumulate cosines. More... | |
float | acc_sin (float x, float y) |
Accumulate sines. More... | |
double | get_yaw () |
Get the yaw orientation of the current pose. More... | |
int | main (int argc, char **argv) |
A ROS node that exchanges relative kinematics between CPSs in a swarm. More... | |
void | pose_callback (const geometry_msgs::PoseStamped::ConstPtr &msg) |
Callback function for position updates. More... | |
cpswarm_msgs::Vector | rel_velocity (geometry_msgs::Vector3 v) |
Compute the velocity difference of the CPS to a given velocity. More... | |
void | swarm_position_callback (cpswarm_msgs::Position msg) |
Callback function for position updates from other swarm members. More... | |
void | swarm_velocity_callback (cpswarm_msgs::Velocity msg) |
Callback function for velocity updates from other swarm members. More... | |
void | vel_callback (const geometry_msgs::TwistStamped::ConstPtr &msg) |
Callback function for velocity updates. More... | |
float acc_cos | ( | float | x, |
float | y | ||
) |
Accumulate cosines.
x | The sum to add to. |
y | The value to compute the cosine for. |
Definition at line 19 of file kinematics_exchanger.cpp.
float acc_sin | ( | float | x, |
float | y | ||
) |
Accumulate sines.
x | The sum to add to. |
y | The value to compute the sine for. |
Definition at line 9 of file kinematics_exchanger.cpp.
double get_yaw | ( | ) |
Get the yaw orientation of the current pose.
Definition at line 27 of file kinematics_exchanger.cpp.
int main | ( | int | argc, |
char ** | argv | ||
) |
A ROS node that exchanges relative kinematics between CPSs in a swarm.
argc | Number of command line arguments. |
argv | Array of command line arguments. |
Definition at line 166 of file kinematics_exchanger.cpp.
void pose_callback | ( | const geometry_msgs::PoseStamped::ConstPtr & | msg | ) |
Callback function for position updates.
msg | Position received from the CPS. |
Definition at line 58 of file kinematics_exchanger.cpp.
cpswarm_msgs::Vector rel_velocity | ( | geometry_msgs::Vector3 | v | ) |
Compute the velocity difference of the CPS to a given velocity.
v | The velocity to compare. |
Definition at line 39 of file kinematics_exchanger.cpp.
void swarm_position_callback | ( | cpswarm_msgs::Position | msg | ) |
Callback function for position updates from other swarm members.
msg | The position received from another CPS. |
Definition at line 85 of file kinematics_exchanger.cpp.
void swarm_velocity_callback | ( | cpswarm_msgs::Velocity | msg | ) |
Callback function for velocity updates from other swarm members.
msg | The velocity received from another CPS. |
Definition at line 130 of file kinematics_exchanger.cpp.
void vel_callback | ( | const geometry_msgs::TwistStamped::ConstPtr & | msg | ) |
Callback function for velocity updates.
msg | Velocity received from the CPS FCU. |
Definition at line 72 of file kinematics_exchanger.cpp.