init pose on bootstrap
cleaner code
enable INIT_POSE