implement first logic

include 4 blocks
bool move_navigation(const float& x, const float& y, const float&
theta);
void rest();
void wake_up();
void posture(const std::string& posture_name);