Moving Magnet Sub with accelerometers and DSP