3D course of action for motion planning of human support robots