Vision Assisted Motion Planning of Robotic Arm For Service Robots