Robot 2-arm dynamics
sort of working
beat random
merge fix