Skip to content

Commit

Permalink
fix spaces
Browse files Browse the repository at this point in the history
  • Loading branch information
isucan committed Jun 8, 2014
1 parent 3821fd5 commit 830e043
Showing 1 changed file with 2 additions and 2 deletions.
4 changes: 2 additions & 2 deletions src/ompl/base/spaces/src/SO3StateSpace.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -62,12 +62,12 @@ namespace ompl
{
static inline void computeAxisAngle(SO3StateSpace::StateType &q, double ax, double ay, double az, double angle)
{
double norm = std::sqrt(ax * ax + ay * ay + az * az);
double norm = std::sqrt(ax * ax + ay * ay + az * az);
if (norm < MAX_QUATERNION_NORM_ERROR)
q.setIdentity();
else
{
double half_angle = angle / 2.0;
double half_angle = angle / 2.0;
double s = sin(half_angle) / norm;
q.x = s * ax;
q.y = s * ay;
Expand Down

0 comments on commit 830e043

Please sign in to comment.