added joint controller initial steps