uhh.... added some angle stuff.
added joint1 and join2 print out