Force control feedback linearization seems to be working