A toolbox for automated driving on the STISIM driving simulator