Added in all necessary methods and method bodies. Need to import Lejos correctly