# A divide-and-conquer implementation of the GJK algorithm

The Gilbert-Johnson-Keerthi (GJK) algorithm is a method for collision detection of convex polyhedra. The method is used in multiple rigid body simulations for computer games.

Given:

• a set of points defining the convex polyhedron A
• a set of points defining the convex polyhedron B

The algorithm returns:

• the distance of the polyhedra
• two closest points
• the two simplices (convex subsets of up to 4 points in 3 dimensions) of A and B containing the two closest points

An n-dimensional simplex is the convex hull of n+1 points as shown in the figure below.

The algorithm makes use of the fact, that the distance between two sets A and B is the distance of the Minkowski difference to the origin:

where

The GJK algorithm iteratively updates a simplex until the closest point to the origin is found.

The algorithm iterates using support points. Given a set M and a vector d, the support point is defined as the furthest point of M in direction d:

The GJK algorithm detects the two closest points of A and B as follows:

1. Choose any point m in M(A,B) in the Minkowski difference of A and B.
2. Set the initial simplex w0 to w0={m}.
3. Let d be the closest point of wk to the origin.
4. If d s(wk, -d)>=d s(M,-d) then return d.
5. Set w'k+1=wk∪{s(M,-d)}
6. Set wk+1 to the smallest simplex in w'k+1 still containing s(M,-d).
7. Continue with step 3.

Note that step 3 requires finding the closest point of the simplex wk to the origin. Most implementations of the GJK algorithm seem to use the following approach:

• Check if the origin is contained in the 3D simplex.
• If not, check whether the origin is near one of the 4 surfaces of the simplex.
• If the origin is not in the Delaunay region of any surface, check whether the origin is near one of the 6 edges.
• If not in a Delaunay region of an edge, find the closest point of the 4 points.

A much more compact implementation can be obtained using a divide-and-conquer approach:

• Let wk={wk0,wk1,...,wkn}
• Solve the least squares equation system
• If all ti>=0 and t1+t2+...+tn<=1 (or n=0), then wk0+Ht is the closest point.
• Otherwise take the closest point of all sub-simplices with n-1 dimensions using the approach above (i.e. recursion).

Note that this approach will visit each edge up to two times, and each point up to three times. The performance is not optimal, but it makes for a much more concise implementation.

The least squares solution is:

Here follows an implementation in Scheme (GNU Guile). By using pairs of points from A and B instead of the Minkowski difference, one can keep track of the information required to determine the pair of closest points of A and B (instead of the closest point of M to the origin).

Here an example of two colliding cuboids simulated using this implementation is shown:

Any feedback, comments, and suggestions are welcome.

Enjoy!

Update:

I noticed that Baraff just uses a separating plane algorithm to achieve the same!

# Minimal OpenGL example

OpenGL is a powerful cross-platform standard for 3D visualisation. OpenGL libraries use a domain specific language (shader language) to describe element-wise operations on vertices (vertex shader) and pixel values (fragment shader). More recent OpenGL versions also support geometry shaders and tesselation shaders (see OpenGL article on Wikipedia).

The learning curve for OpenGL is quite steep at the beginning. The reason is, that a program to draw a triangle is almost as complex as a program drawing thousands of triangles. It is also important to add code for retrieving error messages in order to be able to do development.

I haven't found many minimal examples to understand OpenGL, so I am posting one here. The example draws a coloured triangle on the screen.

The example uses the widely supported OpenGL version 3.1 (which has the version tag 130). You can download, compile, and run the example as follows:

Any feedback, comments, and suggestions are welcome.

Enjoy!

# Steps towards a space simulator

I am quite interested in how simulators such as the Orbiter space simulator are implemented. A spacecraft can be seen as a rigid object with a moments of inertia tensor. Without any forces acting on the object, the rotational moment of the object does not change. In general the moments of inertia tensor causes the direction of the rotation vector to be different at each point in time even if the rotational moment is not changing. This motion can be numerically simulated using a higher order integration method such as 4th order Runge-Kutta. Here is a video showing the resulting simulation of a cuboid tumbling in space:

Brian Vincent Mirtich's thesis demonstrates how to simulate collisions of two convex polyhedra. Furthermore micro-collisions are used as a simple but powerful method to simulate resting contacts. If the micro-collisions are sufficietly small, a resting object can be approximated with sufficient accuracy:

One still needs to implement friction (also shown in Mirtich's thesis) which requires a numerical integral to compute the friction occuring during a micro-collision. Collisions of polyhedra are demonstrated in Mirtich's thesis as well, however it might be simpler to make use of the GJK algorithm. Planetary bodies, spacecraft, and other non-convex objects could be handled by dividing them into multiple convex objects. It would also be interesting to integrate soft body physics as shown in Rigs of Rods. However the accuracy of Rigs of Rods is not sufficiently high for space simulation. E.g. an object tumbling in space would not preserve its momentum.

#### Update:

In the following examples, dynamic Coloumb friction with the ground is simulated.

# This website is now based on Jekyll

Hi, I decided to update the design of my homepage to a responsive HTML design. This makes the web page look nicer on mobile phones. I ended up using the Hyde theme which is based on Poole which in turn is based on Jekyll. I hope you will enjoy the new layout. Here is a demonstration of what Jekyll can do (also to remind myself). See Hyde example for more.

This shows the message style.

The text can be italic or bold.

Quoted text looks like this.

strike through text inserted text

Text with subscript and superscript

Horizontal line

Inline code `looks like this`.

Here is a Gist from Github:

```400: Invalid request
```

• Bullet
• list
• of
• things
1. Enumerated
2. List
1. of
2. things
Totals 21 23
Alice 10 11
Bob 4 3
Charlie 7 9

# Raspberry Pi Zumo robot

Pimoroni sells a Zumo chassis kit which is a low-cost tracked mobile platform. To build a robot, only the following additional components are required (see Github repository for more details):

• micro metal gear motors
• Raspberry Pi Zero W and Micro SD card
• portable power bank
• 4 AA rechargable batteries
• H bridge motor driver
• Raspberry Pi camera module
• wires

In his seminal publication Neural Network Vision for Robot Driving Dean A. Pomerleau shows that one can train a neural network to drive using low-resolution camera images (also see video). In a similar fashion the Zumo robot can first be controlled using an XBox controller. 10 times a second a video frame together with the current motor settings are recorded. The images are downsampled to 32x24 pixels. A neural network with two hidden layers with 20 units each is trained. The output of the neural network are two vectors (one for the left and one for the right motor) with 11 units each. The first unit corresponds to driving backwards with full speed. The last unit corresponds to driving forward with full speed. Initially the robot frequently looses track and a manual override is required. Each time the manual override is used, new training data is recorded. After several iterations the robot finally achieves the desired behaviour and it can patrol the kitchen as shown in the video below.

Regularisation was used to reduce the variance. The bias of the network is quite high but this is probably due to conflicting training data (i.e. over time different drive speeds are used at the same position in the kitchen). Note that the experiment works best in controlled lighting conditions. Otherwise much more training data is required to cope with changes in illumination.