Java MCL Navigation for LEGO Mindstorms