Almost done with the executable that moves joints to desired locations