Added DJdq implementation for COM (only linear part)