altitude working, but have to disable telemetry
commented out altitude for now
still need to get multiple slaves working