More updates to Zigbee communication and servo commands