Started writing the force controller