everything working OK

Added a parameter to the angleLeg function to control the allowed error.
Implemented the color change for the joints.