added straight line test. Only goes forward for a time. no feedback implemented yet