How can I send from crazyflie_ros's scripts that this repository found in gitHub a command to my crazyflie in order to hover on specific height? like for example If I'm not using crazyflie_ros scripts, if I use crazyflie_python scripts then I was sending
Code: Select all
mc.up(0.5)
but in my crazyflie_ros scripts specifically Im using test_high_level.py there's no command for letting my crazyflie to hover on specific height like mc.up, is there any commands that's already written in crazyflie_ros's python that I can use it for hovering my crazyflie to specific height? if not, then what you please suggest me to change in my firmware in order for instance by goto command to let my crazyflie hover on specific height? lets assume first I want my crazyflie to hover always on height 0.3 by using any commands of crazyflie_ros.. so what should I change in my crazyflie's firmware to do that?! maybe I can change the functionality in goto function? if so, what should I do? THANKS ALOT
this is goto function, maybe if I change hover_pos to setpoints that I want will let my crazyflie hover on specific height?
Code: Select all
int go_to(const struct data_go_to* data)
{
int result = 0;
if (isInGroup(data->groupMask)) {
struct vec hover_pos = mkvec(data->x, data->y, data->z);
xSemaphoreTake(lockTraj, portMAX_DELAY);
float t = usecTimestamp() / 1e6;
result = plan_go_to(&planner, data->relative, hover_pos, data->yaw, data->duration, t);
xSemaphoreGive(lockTraj);
}
return result;
}