SO3StateSpace.h
void setName(const std::string &name)
Set the name of the state space.
Definition: StateSpace.cpp:212
void freeState(State *state) const override
Free the memory of the allocated state.
Definition: SO3StateSpace.cpp:325
bool equalStates(const State *state1, const State *state2) const override
Checks whether two states are equal.
Definition: SO3StateSpace.cpp:274
A shared pointer wrapper for ompl::base::StateSampler.
void serialize(void *serialization, const State *state) const override
Write the binary representation of state to serialization.
Definition: SO3StateSpace.cpp:231
A state space representing SO(3). The internal representation is done with quaternions. The distance between states is the angle between quaternions and interpolation is done with slerp.
Definition: SO3StateSpace.h:82
StateSamplerPtr allocDefaultStateSampler() const override
Allocate an instance of the default uniform state sampler for this space.
Definition: SO3StateSpace.cpp:315
unsigned int getDimension() const override
Get the dimension of the space (not the dimension of the surrounding ambient space) ...
Definition: SO3StateSpace.cpp:159
bool satisfiesBounds(const State *state) const override
Check if a state is inside the bounding box. For unbounded spaces this function can always return tru...
Definition: SO3StateSpace.cpp:211
void copyState(State *destination, const State *source) const override
Copy a state to another. The memory of source and destination should NOT overlap. ...
Definition: SO3StateSpace.cpp:216
void interpolate(const State *from, const State *to, double t, State *state) const override
Computes the state that lies at time t in [0, 1] on the segment that connects from state to to state...
Definition: SO3StateSpace.cpp:284
void printState(const State *state, std::ostream &out) const override
Print a state to a stream.
Definition: SO3StateSpace.cpp:371
ompl::base::State StateType
Define the type of state allocated by this space.
Definition: StateSpace.h:78
The definition of a state in SO(3) represented as a unit quaternion.
Definition: SO3StateSpace.h:90
void enforceBounds(State *state) const override
Bring the state within the bounds of the state space. For unbounded spaces this function can be a no-...
Definition: SO3StateSpace.cpp:181
double distance(const State *state1, const State *state2) const override
Computes distance between two states. This function satisfies the properties of a metric if isMetricS...
Definition: SO3StateSpace.cpp:265
double norm(const StateType *state) const
Compute the norm of a state.
Definition: SO3StateSpace.cpp:175
State space sampler for SO(3), using quaternion representation.
Definition: SO3StateSpace.h:47
Representation of a space in which planning can be performed. Topology specific sampling, interpolation and distance are defined.
Definition: StateSpace.h:70
double * getValueAddressAtIndex(State *state, unsigned int index) const override
Many states contain a number of double values. This function provides a means to get the memory addre...
Definition: SO3StateSpace.cpp:366
void setAxisAngle(double ax, double ay, double az, double angle)
Set the quaternion from axis-angle representation. The angle is given in radians. ...
Definition: SO3StateSpace.cpp:86
void deserialize(State *state, const void *serialization) const override
Read the binary representation of a state from serialization and write it to state.
Definition: SO3StateSpace.cpp:236
double getMeasure() const override
Get a measure of the space (this can be thought of as a generalization of volume) ...
Definition: SO3StateSpace.cpp:169
void printSettings(std::ostream &out) const override
Print the settings for this state space to a stream.
Definition: SO3StateSpace.cpp:384
void registerProjections() override
Register the projections for this state space. Usually, this is at least the default projection...
Definition: SO3StateSpace.cpp:330
void sampleGaussian(State *state, const State *mean, double stdDev) override
Sample a state such that the expected distance between mean and state is stdDev.
Definition: SO3StateSpace.cpp:117
State * allocState() const override
Allocate a state that can store a point in the described space.
Definition: SO3StateSpace.cpp:320
unsigned int getSerializationLength() const override
Get the number of chars in the serialization of a state in this space.
Definition: SO3StateSpace.cpp:226
void sampleUniformNear(State *state, const State *near, double distance) override
To sample unit quaternions uniformly within some given distance, we sample a 3-vector from the R^3 ta...
Definition: SO3StateSpace.cpp:102
double getMaximumExtent() const override
Get the maximum value a call to distance() can return (or an upper bound). For unbounded state spaces...
Definition: SO3StateSpace.cpp:164