If joint near singularity, restore angle to start values, adapt other joints