Twist controller and lwa4p_extended fixes

for testing with cob4 hardware