Added entities to the sim state. Make sure these are initialised properly.
Fixed setX(.) to handle the number of dimensions in X correctly.
Further debugging of the graphics to represent the person and a simple task to get the person walking. Trajectory is correct, but graphics currently screwed up.