Six axis robots

Features
5

Thanks Kevin. This does give me somewhere to start lookng in to the klipper code.