Custom wam messages and services with a sample teleop demo