removed the for(;;); which stops simulation. ready to test on robot