Programming Fanuc Robot w/ wait and call function