TF added. Rotation using roll palm. Debug mode added. Open/close hand added