added teachericubheights
Added icub_experiment and create_dmp function