Pseudo Code for the HW FTC Team