Update Trinket_Robot.ino

Reworking the code to fit with the setup info.