Fixed tests & legs back

Fixed the leg and elbow tests
Fixed the command specs for legs and elbows
merged upstream