SAP Analysis only run when robots are at a joint