adding working serial code from ajc imageproc+ros