mrkjankovic / TrajOpt

A trajectory optimization library for Matlab

TrajOpt - Trajectory Optimization for Matlab

TrajOpt is a matlab library designed for solving continuous-time single-phase trajectory optimization problems. I developed it while working on my PhD at Cornell, studying non-linear controller design for walking robots.

What sort of problems does TrajOpt solve?

Examples:

• Cart-pole swing-up: Find the force profile to apply to the cart to swing-up the pendulum that freely hanges from it.
• Compute the gait (joint angles, rates, and torques) for a walking robot that minimizes the energy used while walking.
• Find a minimum-thrust orbit transfer trajectory for a satellite.

Details:

TrajOpt finds the optimal trajectory for a dynamical system. This trajectory is a sequence of controls (expressed as a function) that moves the dynamical system between two points in state space. The trajectory will minimize some cost function, which is typically an integral along the trajectory. The trajectory will also satisfy a set user-defined constraints.

TrajOpt solves problems with

• continuous dynamics
• boundary constraints
• path constraints
• integral cost function
• boundary cost function

All functions in the problem description can be non-linear, but they must be smooth (C2 continuous).

Features:

• Easy to install - no dependencies outside of Matlab (for base functionality)
• Lots of examples - look at the demo/ directory to see for yourself!
• Readable source code - easy to debug your code and figure out how the software works
• Analytic gradients - most methods support analytic gradients
• Rapidly switch methods - choose from a variety of methods:
  • direct collocation
    • trapezoid
    • Hermite-Simpson (seperated)
  • direct multiple shooting
    • 4th-order Runge-Kutta
  • global (pseudospectral) collocation
    • Chebyshev (Lobatto) -- (requires chebfun)

Installation:

1. Clone or download the repository
2. Add the top level folder to your Matlab path
3. (Optional) Clone or download chebfun (needed for global collocation)
4. Done!

Usage:

• Call the function trajOpt from inside matlab.
• trajOpt takes a single argument: a struct that describes your trajectory optimization problem.
• trajOpt returns a struct that describes the solution. It contains a full description of the problem, the transcription method that was used, and the solution (both as a vector of points and a function handle for interpolation).
• For more details, type help trajOpt at the command line, or check out some of the examples in the demo/ directory.

Contribute:

This code is still under development, and will be from now until at least May 2016. Please contact me if you have any comments or suggestions, or create a pull request if you would like to add content.

If you are interested in contributing, here are a few possible things to do:

• Create additional demo problems
• Identify holes in the documentation
• Report bugs
• Implement new methods or features

Contributions:

• Will Wehner wrote the code that enables analytic gradients in the multiple shooting method (4th-order Runge-Kutta).