updated Khepera drawing code
added a controller
heading callculations need fixing.