Target Localization and Sensor Movement Trajectory Planning with Bearing-Only Measurements in Three Dimensional Space