Working code 1

Ran successfully at Saturday pilot