building joint controller
implemented joint controller. needs trajectory generator.
minor changes