Updated code.

Working on the last part (cool pose) not complete