Added safety light and tank drive logic