fullbody solver working nicely