Change input pointcloud FOV about px4-avoidance HOT 7 OPEN

Thank you :) I will let you know my results.

from px4-avoidance.

@Cristian-wp I'm not pretty sure, but I think you can try to modify the updateFOVFromMaxima in common.cpp and set the h_fov_deg by your own. And you should also modify FOV relative func like isOnEdgeOfFOV and scaleToFOV etc...... to make sure the path is ALWAYS in the FOV, since you are using lidar.

from px4-avoidance.

Hi @CWC107753035 thank you for your feedback.
I had done a little software analisys on local_planner and my conclusion in similar. I have also find reference in PX4-Avoidance/avoidance/src/common.cpp , but I was thinking to modify only these two:
1)

bool pointInsideFOV(const std::vector<FOV>& fov_vec, const PolarPoint& p_pol) {
  for (auto fov : fov_vec) {
    if (pointInsideFOV(fov, p_pol)) {
      return true;
    }
  }
  return false;
}

bool pointInsideFOV(const FOV& fov, const PolarPoint& p_pol) {
  return p_pol.z <= wrapAngleToPlusMinus180(fov.yaw_deg + fov.h_fov_deg / 2.f) &&
         p_pol.z >= wrapAngleToPlusMinus180(fov.yaw_deg - fov.h_fov_deg / 2.f) &&
         p_pol.e <= fov.pitch_deg + fov.v_fov_deg / 2.f && p_pol.e >= fov.pitch_deg - fov.v_fov_deg / 2.f;
}

When I perform the modification I will let you know the results.
Have you already done something similar in the code?

from px4-avoidance.

@Cristian-wp I only tried to change the FOV horizontal degree from calculation result to certain value, as I find out our real drone's FOV is unreasonably big and caused some problem. I only tested on the simulator(rviz) for now and it works fine.

from px4-avoidance.

@CWC107753035 Can I ask you you new FOV value?

from px4-avoidance.

@Cristian-wp I only have a front camera so I just simply modify
fov.v_fov_deg = 50; fov.h_fov_deg = 50; fov.pitch_deg = 0; fov.yaw_deg = 0;

from px4-avoidance.

@Cristian-wp @CWC107753035 Could you tell me what are the steps and files to change for the integration of the lidar?

from px4-avoidance.