update round_to as function handle
update time per step algorithm
use feval instead of anonymous function