Much of the research on motion optimization (see here) is validated on the Max Planck Institute's dual arm manipulation platform Apollo. Here's a video describing it's basic capabilities. The research platform was setup by Jeannette Bohg, and much of the underlying control architecture was designed by Ludovic Righetti and Mrinal Kalakrishnan.