added G28 command
Donr porting G02 G03 form RapRep; imple fastsin