fixed offset error in robot placement
fixed sphere error
intermediate states when two much contact changes
ug fix in aglo