Task and Motion Planning with Behavior Trees for Locomotion and Manipulation