https://www.cafzone.net/2014/08/real-time-control-system-for-humanoids/