A Novel 3D Analytical Algorithm for Autonomous Collision Avoidance considering Cylindrical Safety Bubble