Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- let adc: number[] = []
- let channel_addr: number[] = []
- let speed = 0
- function read_adc() {
- for (let index = 0; index <= 1; index++) {
- pins.i2cWriteNumber(
- 72,
- channel_addr[index],
- NumberFormat.UInt8LE,
- false
- )
- adc[index] = pins.i2cReadNumber(72, NumberFormat.UInt16BE, false)
- }
- }
- function forward() {
- pins.digitalWritePin(DigitalPin.P13, 1)
- pins.digitalWritePin(DigitalPin.P15, 0)
- pins.analogWritePin(AnalogPin.P14, speed)
- pins.analogWritePin(AnalogPin.P16, speed)
- }
- function backward() {
- pins.digitalWritePin(DigitalPin.P13, 0)
- pins.digitalWritePin(DigitalPin.P15, 1)
- pins.analogWritePin(AnalogPin.P16, speed)
- pins.analogWritePin(AnalogPin.P14, speed)
- }
- function spin_right() {
- pins.digitalWritePin(DigitalPin.P13, 1)
- pins.digitalWritePin(DigitalPin.P15, 1)
- pins.analogWritePin(AnalogPin.P16, speed)
- pins.analogWritePin(AnalogPin.P14, speed)
- }
- function spin_left() {
- pins.digitalWritePin(DigitalPin.P13, 0)
- pins.digitalWritePin(DigitalPin.P15, 0)
- pins.analogWritePin(AnalogPin.P16, speed)
- pins.analogWritePin(AnalogPin.P14, speed)
- }
- function ao() {
- pins.digitalWritePin(DigitalPin.P13, 0)
- pins.digitalWritePin(DigitalPin.P15, 0)
- pins.analogWritePin(AnalogPin.P16, 0)
- pins.analogWritePin(AnalogPin.P14, 0)
- }
- radio.onDataPacketReceived( ({ receivedNumber }) => {
- if (receivedNumber == 1) {
- forward()
- } else if (receivedNumber == 2) {
- spin_left()
- basic.pause(200)
- ao()
- } else if (receivedNumber == 3) {
- spin_right()
- basic.pause(200)
- ao()
- } else if (receivedNumber == 4) {
- backward()
- } else {
- ao()
- }
- })
- speed = 600
- radio.setTransmitPower(7)
- radio.setGroup(56)
Advertisement
Add Comment
Please, Sign In to add comment