/

Named constructor from angle in radians

\brief Reports whether previous computation was successful. * * \returns \c Success if computation was succesful, * \c Nume

Resizes the matrix to a \a rows x \a cols matrix and initializes it to zero * \sa resizeNonZeros(Index), reserve(), setZero() */

/

/

/

\brief Retruns the y-translation by value. **/

/

Returns the length of the array.

/

/

Removes all non zeros */

* calculate the error of the factor * Override for systems with unusual noise models */

/ ! This function prints an error message and exits */ /

Solve the inverse geodesic problem. <p> @param lat1 latitude of point 1 (degrees). @param lon1 longitude of point 1 (degrees). @param lat2 latitude of

/

AssertEqual function that prints out actual and expected if not equal. Usage: self.gtsamAssertEqual(actual,expected)

project a point from world InvDepth parameterization to the image * @param pw is a point in the world coordinate * @param H1 is the jacobian w

Get the number of rows.

Square a number. <p> @param x the argument. @return <i>x</i>².

Check if there are any cliques in the tree */

Evaluate measurement error h(x)-z

/

\sa MatrixBase::setIdentity() */

Default constructor for I/O */

/ see doc/math.lyx, SE(2) section

get x

Iterator to beginning of factors. */

The number of variables in this config */

/

Returns a pointer to the underlying element array.

Sanitize docstrings and add custom failure explanation

/

* Linearize a non-linearFactor2 to get a GaussianFactor * Ax-b \approx h(x1+dx1,x2+dx2)-z = h(x1,x2) + A2*dx1 + A2*dx2 - z * Hence b = z - h(x1,

Sanitize messages and add custom failure explanation

add a key-value pair */

Return the best elapsed time in seconds */

Number of variables stored. */

\returns a const pointer to the array of the starting positions of the inner vectors. * This function is aimed at interoperability with other li

\returns the value of the matrix at position \a i, \a j * This function returns Scalar(0) if the element is an explicit \em zero */

\brief Returns an expression of the tridiagonal matrix T in the decomposition * * \returns expression object representing the matrix T