added DMP support, minor fixes - quaternions currently unimplented, planning this for tomorrow