Loading...
Searching...
No Matches
dipla_gp_belief_planner.hpp
Go to the documentation of this file.
286void condition(Matrix& covariance, Vector* mean, const Sensor& sensor, const Vector* measurement);
Eigen-style Aigen values and build-selected planner aliases.
static bool start(uint32_t session)
Admit a nonzero session and discard correlation from the previous one.
Definition dipla_camera_backend.c:170
Definition compat.hpp:242
dipla::aigenlib::Sensor Sensor
Sparse block-averaging observation operator.
Definition dipla_gp_belief_planner.hpp:124
double fov_radius(double altitude, double angle)
Compute the ground-plane footprint radius from altitude and full FOV angle.
Definition dipla_gp_belief_planner.cpp:230
constexpr int lookahead_measurement_budget
Definition dipla_gp_belief_planner.hpp:40
std::vector< Point > refine(const Grid &grid, const Vector &mean, const Matrix &covariance, const Point &start, const std::vector< Point > &initial, const PlannerOptions &options)
Refine a greedy route with bounded CMA-ES while retaining its best candidate.
Definition cmaes_optimizer.cpp:55
std::vector< Point > plan(const Grid &grid, const Vector &mean, const Matrix &covariance, const Point &start, const PlannerOptions &options)
Run greedy route selection followed by optional CMA-ES refinement.
Definition cmaes_optimizer.cpp:114
int resolution_block_size(double altitude)
Select the research sensor's altitude-dependent aggregation block size.
Definition dipla_gp_belief_planner.cpp:238
double noise_model(double altitude, double minimum_altitude)
Compute modeled observation variance at an altitude.
Definition dipla_gp_belief_planner.cpp:248
constexpr int spline_samples_per_segment
Definition dipla_gp_belief_planner.hpp:42
std::vector< Point > spline(const Point &start, const std::vector< Point > &waypoints, int samples_per_segment)
Interpolate controls with a natural cubic spline parameterized by distance.
Definition dipla_gp_belief_planner.cpp:573
std::vector< bool > importance_mask(const Vector &mean, const Matrix &covariance, const PlannerOptions &options)
Select cells whose confidence bounds satisfy the utility threshold.
Definition dipla_gp_belief_planner.cpp:417
Matrix initialize_covariance(const Grid &grid, double sigma2, double lengthscale)
Initialize a dense Matérn-3/2 GP covariance matrix.
Definition dipla_gp_belief_planner.cpp:262
Vector sample_sensor_noise(const Sensor &sensor, std::mt19937_64 &generator)
Draw independent zero-mean noise using each sensor row's variance.
Definition dipla_gp_belief_planner.cpp:398
double trajectory_objective(const Grid &grid, const Matrix &covariance, const std::vector< bool > &mask, const Point &start, const std::vector< Point > &raw_waypoints, const PlannerOptions &options)
Score a trajectory by safety violation and distance-normalized information gain.
Definition dipla_gp_belief_planner.cpp:635
double expected_reduction(const Matrix &covariance, const std::vector< bool > &mask, const Sensor &sensor)
Sum expected marginal-variance reduction over important cells.
Definition dipla_gp_belief_planner.cpp:441
Sensor future_sensor(const Grid &grid, const std::vector< Point > &path, double angle, int stride, int max_measurements, double observation_variance)
Approximate future measurements along a path under a bounded budget.
Definition dipla_gp_belief_planner.cpp:335
Sensor build_sensor(const Grid &grid, const Point &pose, double angle, double observation_variance)
Build one block-averaged sensor footprint at a pose.
Definition dipla_gp_belief_planner.cpp:296
void condition(Matrix &covariance, Vector *mean, const Sensor &sensor, const Vector *measurement)
Apply a Gaussian linear-observation update in place.
Definition dipla_gp_belief_planner.cpp:473
std::vector< Point > grid_search(const Grid &grid, const Vector &mean, const Matrix &covariance, const Point &start, const PlannerOptions &options)
Greedily select a bounded route by information gain per travel cost.
Definition dipla_gp_belief_planner.cpp:678
std::vector< Point > lattice(const Grid &grid, const PlannerOptions &options)
Generate the deduplicated coarse-to-fine candidate lattice.
Definition dipla_gp_belief_planner.cpp:531
Vector observe(const Sensor &sensor, const Vector &field)
Apply the sensor's block averages to a full-grid field.
Definition dipla_gp_belief_planner.cpp:379
Point clip_point(const Grid &grid, const Point &point, const PlannerOptions &options)
Clamp a candidate to the map safety inset and altitude interval.
Definition dipla_gp_belief_planner.cpp:516
int nearest_y(double value) const
Find the nearest clamped row; half-cell ties round downward.
Definition dipla_gp_belief_planner.cpp:215
int nearest_x(double value) const
Find the nearest clamped column; half-cell ties round downward.
Definition dipla_gp_belief_planner.cpp:203
double x(int column) const
Convert a column index to its east coordinate.
Definition dipla_gp_belief_planner.cpp:194
double y(int row) const
Convert a row index to its north coordinate.
Definition dipla_gp_belief_planner.cpp:196
Grid(double xminimum=0.0, double xmaximum=100.0, double yminimum=0.0, double ymaximum=100.0, double spacing=2.0)
Create a grid and align its effective upper bounds.
Definition dipla_gp_belief_planner.cpp:173
Search, utility, and optimizer controls for the reference planner.
Definition dipla_gp_belief_planner.hpp:131
bool lower_confidence_bound
Definition dipla_gp_belief_planner.hpp:159
std::function< bool()> keep_planning
Definition dipla_gp_belief_planner.hpp:167
double observation_variance
Definition dipla_gp_belief_planner.hpp:163
One timestamped geographic position for a replay annotation.
Definition ear_heatmap_overlay.c:79