cartesian follow pid commands working