In this paper, we presents a behavior planning for humanoid robots using behavior primitive in 3 dimensional workspace. Also, we define behavior primitives that humanoid robot accomplishes various tasks effectively. Humanoid robot obtains information of the outside environment and its inner information from various sensors in complex workspace with various obstacles. We verify our approach on a developed small humanoid robot using embedded vision and sensor system in a experimental environment. The experimental results show that the humanoid robot performs its tasks fast and effectively.