00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00023
00024
00025
00026
00027
00028
00029
00030
00031
00032
00033
00034
00035
00036
00037 #ifndef OMPL_BASE_SPACES_SO2_STATE_SPACE_
00038 #define OMPL_BASE_SPACES_SO2_STATE_SPACE_
00039
00040 #include "ompl/base/StateSpace.h"
00041
00042 namespace ompl
00043 {
00044 namespace base
00045 {
00046
00048 class SO2StateSampler : public StateSampler
00049 {
00050 public:
00051
00053 SO2StateSampler(const StateSpace *space) : StateSampler(space)
00054 {
00055 }
00056
00057 virtual void sampleUniform(State *state);
00058 virtual void sampleUniformNear(State *state, const State *near, const double distance);
00059 virtual void sampleGaussian(State *state, const State *mean, const double stdDev);
00060 };
00061
00065 class SO2StateSpace : public StateSpace
00066 {
00067 public:
00068
00070 class StateType : public State
00071 {
00072 public:
00073
00075 void setIdentity(void)
00076 {
00077 value = 0.0;
00078 }
00079
00081 double value;
00082 };
00083
00084 SO2StateSpace(void) : StateSpace()
00085 {
00086 setName("SO2" + getName());
00087 type_ = STATE_SPACE_SO2;
00088 }
00089
00090 virtual ~SO2StateSpace(void)
00091 {
00092 }
00093
00094 virtual unsigned int getDimension(void) const;
00095
00096 virtual double getMaximumExtent(void) const;
00097
00098 virtual void enforceBounds(State *state) const;
00099
00100 virtual bool satisfiesBounds(const State *state) const;
00101
00102 virtual void copyState(State *destination, const State *source) const;
00103
00104 virtual double distance(const State *state1, const State *state2) const;
00105
00106 virtual bool equalStates(const State *state1, const State *state2) const;
00107
00108 virtual void interpolate(const State *from, const State *to, const double t, State *state) const;
00109
00110 virtual StateSamplerPtr allocStateSampler(void) const;
00111
00112 virtual State* allocState(void) const;
00113
00114 virtual void freeState(State *state) const;
00115
00116 virtual double* getValueAddressAtIndex(State *state, const unsigned int index) const;
00117
00118 virtual void printState(const State *state, std::ostream &out) const;
00119
00120 virtual void printSettings(std::ostream &out) const;
00121
00122 virtual void registerProjections(void);
00123 };
00124 }
00125 }
00126
00127 #endif