modified to publish current load as effort in joint states