Added joint state publishing for vrep