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.
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
Innovation-system row budget, independent of worker FIFO capacity.
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
Default emitted spline samples per control 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
constexpr int lookahead_stride
Default route-pose sampling interval for look-ahead scoring.
Definition dipla_gp_belief_planner.hpp:38
math::Point Point
Three-dimensional local east/north/altitude point, in metres.
Definition dipla_gp_belief_planner.hpp:49
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
math::Matrix Matrix
Dense row-major covariance layout chosen for contiguous row updates.
Definition dipla_gp_belief_planner.hpp:45
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
math::Vector Vector
Dynamic GP mean, measurement, or per-cell variance vector.
Definition dipla_gp_belief_planner.hpp:47
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
double xmax
Inclusive, grid-aligned upper east bound in metres.
Definition dipla_gp_belief_planner.hpp:61
int nearest_x(double value) const
Find the nearest clamped column; half-cell ties round downward.
Definition dipla_gp_belief_planner.cpp:203
double xmin
Inclusive lower east bound in metres.
Definition dipla_gp_belief_planner.hpp:59
double x(int column) const
Convert a column index to its east coordinate.
Definition dipla_gp_belief_planner.cpp:194
double ymax
Inclusive, grid-aligned upper north bound in metres.
Definition dipla_gp_belief_planner.hpp:65
double ymin
Inclusive lower north bound in metres.
Definition dipla_gp_belief_planner.hpp:63
int size() const
Return the number of grid cells.
Definition dipla_gp_belief_planner.cpp:192
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
Choose lower-confidence-bound versus upper-confidence-bound utility.
Definition dipla_gp_belief_planner.hpp:159
double threshold
Field-value threshold used to define planning importance.
Definition dipla_gp_belief_planner.hpp:135
int maxfevals
Maximum objective evaluations; an incomplete population is not run.
Definition dipla_gp_belief_planner.hpp:155
std::function< bool()> keep_planning
Optional cooperative continue predicate, checked during planning.
Definition dipla_gp_belief_planner.hpp:167
double cost_exponent
Exponent used to penalize travel distance.
Definition dipla_gp_belief_planner.hpp:143
int maxiter
Maximum CMA-ES generations.
Definition dipla_gp_belief_planner.hpp:151
double zmax
Maximum permitted altitude in metres.
Definition dipla_gp_belief_planner.hpp:139
double beta
Confidence multiplier applied to posterior standard deviation.
Definition dipla_gp_belief_planner.hpp:133
bool refine
Run CMA-ES refinement after greedy lattice selection.
Definition dipla_gp_belief_planner.hpp:161
long seed
Reproducible optimizer seed.
Definition dipla_gp_belief_planner.hpp:157
double step_z
Initial CMA-ES standard deviation for altitude.
Definition dipla_gp_belief_planner.hpp:147
double zmin
Minimum permitted altitude in metres.
Definition dipla_gp_belief_planner.hpp:137
int horizon
Greedy waypoint count.
Definition dipla_gp_belief_planner.hpp:149
double angle_of_view
Full sensor field-of-view angle in degrees.
Definition dipla_gp_belief_planner.hpp:141
int popsize
CMA-ES population size and evaluation batch size.
Definition dipla_gp_belief_planner.hpp:153
double observation_variance
Fixed observation variance; negative selects the altitude noise model.
Definition dipla_gp_belief_planner.hpp:163
unsigned margin_cells
Horizontal control inset in grid cells, independent of altitude.
Definition dipla_gp_belief_planner.hpp:165
double step_xy
Initial CMA-ES standard deviation for horizontal coordinates.
Definition dipla_gp_belief_planner.hpp:145