Fix JSON waypoint response message to report status of all end effectors
Merge remote-tracking branch 'origin/refactor' into refactor