Finished creating commands using test development also added test program without NXT stuff