Got some very crude triple integrated force control working (fairly oscillatory but non the less still does work to control force VERY crudely