Motion planning using the modified visibility graph

We consider the problem of planning robot motion in a plane with two constraints on the trajectory: being short and comfortable. Based on the visibility graph principles, our method encloses costs due to the kinematics of the robot and to the shape of the free space.