Added command slave code to repo. Winter quarter

Includes fix for timeout, distance, and roundup function