Having done a fair bit of testing and refining on the finite state machine code, I've posted it on http://asmith.id.au/state-machine.html along with the definition for the diagram posted yesterday, and a sample script that runs on it. I guess the next step is to create a simple robot simulator to go with it.