added backtrace message when segfault
fixed 'write_servo', caused segfault