Updated Arduino controller to 115200 baud
Updated code to include laser diode switching. Still having an issue with the switching happening too fast I think.