Collision free trajectory planning for hybrid manipulators