Small software tweaks, updated to latest BSP