Fix admittance controller interface read/write logic

Fix admittance controller interface read/write logic #514