Further MCPC+ fixes

Signed-off-by: Ross Allan <rallanpcl@gmail.com>