WiringPi first pass

Author: BenChung

deploy/Manifest.toml

@@ -2,7 +2,7 @@
 
 julia_version = "1.12.4"
 manifest_format = "2.0"
-project_hash = "ffb87b643daea33674fe3b248d832b13237c53d3"
+project_hash = "1f4210cd068465307a9c95f53a8d8f3e44b6baa9"
 
 [[deps.ArgTools]]
 uuid = "0dad84c5-d112-42e6-8d28-ef12dabb789f"
@@ -35,6 +35,12 @@ version = "1.7.0"
 uuid = "7b1f6079-737a-58dc-b8bc-7a2ca5c1b5ee"
 version = "1.11.0"
 
+[[deps.JLLWrappers]]
+deps = ["Artifacts", "Preferences"]
+git-tree-sha1 = "0533e564aae234aff59ab625543145446d8b6ec2"
+uuid = "692b3bcd-3c85-4b1f-b108-f13ce0eb3210"
+version = "1.7.1"
+
 [[deps.JuliaSyntaxHighlighting]]
 deps = ["StyledStrings"]
 uuid = "ac6e5ff7-fb65-4e79-a425-ec3bc9c03011"
@@ -101,12 +107,6 @@ deps = ["Artifacts", "Libdl"]
 uuid = "458c3c95-2e84-50aa-8efc-19380b2a3a95"
 version = "3.5.4+0"
 
-[[deps.PiGPIO]]
-deps = ["Sockets"]
-path = "dev/PiGPIO"
-uuid = "bb151fc1-c6dc-5496-8ed6-07f94907e623"
-version = "0.2.1"
-
 [[deps.Pkg]]
 deps = ["Artifacts", "Dates", "Downloads", "FileWatching", "LibGit2", "Libdl", "Logging", "Markdown", "Printf", "Random", "SHA", "TOML", "Tar", "UUIDs", "p7zip_jll"]
 uuid = "44cfe95a-1eb2-52ea-b672-e2afdf69b78f"
@@ -144,10 +144,6 @@ version = "1.11.0"
 uuid = "ea8e919c-243c-51af-8825-aaa63cd721ce"
 version = "0.7.0"
 
-[[deps.Sockets]]
-uuid = "6462fe0b-24de-5631-8697-dd941f90decc"
-version = "1.11.0"
-
 [[deps.StaticArrays]]
 deps = ["LinearAlgebra", "PrecompileTools", "Random", "StaticArraysCore"]
 git-tree-sha1 = "eee1b9ad8b29ef0d936e3ec9838c7ec089620308"
@@ -202,6 +198,18 @@ version = "1.11.0"
 uuid = "4ec0a83e-493e-50e2-b9ac-8f72acf5a8f5"
 version = "1.11.0"
 
+[[deps.WiringPi]]
+deps = ["WiringPi_jll"]
+git-tree-sha1 = "9c9733c7f8ca73698ce601fc2df625be5270f334"
+uuid = "56b06491-0088-44d9-858f-9bc194f2c904"
+version = "0.2.2"
+
+[[deps.WiringPi_jll]]
+deps = ["Artifacts", "JLLWrappers", "Libdl"]
+git-tree-sha1 = "99a7679f9e8618aca73b022548c032eecdac42e1"
+uuid = "39e6258f-44e5-5edf-b49b-51a5e5bce6ab"
+version = "3.16.0+0"
+
 [[deps.Zlib_jll]]
 deps = ["Libdl"]
 uuid = "83775a58-1f1d-513f-b197-d71354ab007a"

deploy/Project.toml

@@ -1,5 +1,5 @@
 [deps]
-PiGPIO = "bb151fc1-c6dc-5496-8ed6-07f94907e623"
 Printf = "de0858da-6303-5e67-8744-51eddeeeb8d7"
 StaticArrays = "90137ffa-7385-5640-81b9-e52037218182"
 Timers = "21f18d07-b854-4dab-86f0-c15a3821819a"
+WiringPi = "56b06491-0088-44d9-858f-9bc194f2c904"

deploy/src/encoder.jl

@@ -1,26 +1,25 @@
-using PiGPIO
+using WiringPi
 
 #=============================================================================
   Encoder Struct and Basic Operations
 =============================================================================#
 
 mutable struct Encoder
-    p::Pi
     pin::Int
     count::Int
     state::Bool
 end
 
-function Encoder(p::Pi, pin::Int)
-    return Encoder(p, pin, 0, PiGPIO.read(p, pin) == 1)
+function Encoder(pin::Int)
+    return Encoder(pin, 0, digitalRead(pin) == HIGH)
 end
 
 function step!(e::Encoder)
-    new_state = PiGPIO.read(e.p, e.pin)
-    if e.state && new_state == 0
+    new_state = digitalRead(e.pin)
+    if e.state && new_state == LOW
         e.count += 1
         e.state = false
-    elseif !e.state && new_state == 1
+    elseif !e.state && new_state == HIGH
         e.state = true
     end
 end
@@ -43,7 +42,7 @@ Send commands via the command channel, receive count via the response channel.
 
 # Example
 ```julia
-enc = Encoder(pi, pin)
+enc = Encoder(pin)
 tenc = ThreadedEncoder(enc, 1_000_000)  # 1ms poll interval
 
 # Read current count

deploy/src/main.jl

@@ -1,9 +1,9 @@
-using PiGPIO
+using WiringPi
 using Timers
 include(joinpath(@__DIR__, "mpu6000.jl"))
 include(joinpath(@__DIR__, "encoder.jl"))
 
-module BalanceController 
+module BalanceController
 include(joinpath(@__DIR__, "balance_original.jl"))
 end
 
@@ -16,9 +16,11 @@ const PWMB_RIGHT = 18 # both have hardware PWM
 const LTRANS_OE = 11 # enables the 3.3V <-> 5V level translator
 const STBY_PIN = 0
 
+const PWM_RANGE = 1024  # Hardware PWM duty cycle range (0-1024)
+
 function handle_err(ec)
     if ec == 0
-        return 
+        return
     end
     println(Core.stdout, "Had error ", ec)
     return
@@ -34,12 +36,12 @@ end
 
 Stop both motors by setting PWM to 0 and appropriate direction pins.
 """
-function car_stop!(p::Pi)
-    write(p, AIN1, 1)     # HIGH
-    write(p, BIN1, 0)     # LOW
-    write(p, STBY_PIN, 1) # HIGH (standby off = enabled, but PWM=0)
-    PiGPIO.set_PWM_dutycycle(p, PWMA_LEFT, 0)
-    PiGPIO.set_PWM_dutycycle(p, PWMB_RIGHT, 0)
+function car_stop!()
+    digitalWrite(AIN1, HIGH)
+    digitalWrite(BIN1, LOW)
+    digitalWrite(STBY_PIN, HIGH) # standby off = enabled, but PWM=0
+    pwmWrite(PWMA_LEFT, 0)
+    pwmWrite(PWMB_RIGHT, 0)
 end
 
 """
@@ -48,51 +50,70 @@ end
 Apply PWM signals to motors based on computed control values.
 Handles direction pin setting based on PWM sign.
 """
-function apply_motor_output!(p::Pi, pwm_left::Float32, pwm_right::Float32)
+function apply_motor_output!(pwm_left::Float32, pwm_right::Float32)
     # Left motor
     if pwm_left < 0
-        write(p, AIN1, 1)
-        PiGPIO.set_PWM_dutycycle(p, PWMA_LEFT, round(Int, -pwm_left))
+        digitalWrite(AIN1, HIGH)
+        pwmWrite(PWMA_LEFT, round(Int, -pwm_left))
     else
-        write(p, AIN1, 0)
-        PiGPIO.set_PWM_dutycycle(p, PWMA_LEFT, round(Int, pwm_left))
+        digitalWrite(AIN1, LOW)
+        pwmWrite(PWMA_LEFT, round(Int, pwm_left))
     end
 
     # Right motor
     if pwm_right < 0
-        write(p, BIN1, 1)
-        PiGPIO.set_PWM_dutycycle(p, PWMB_RIGHT, round(Int, -pwm_right))
+        digitalWrite(BIN1, HIGH)
+        pwmWrite(PWMB_RIGHT, round(Int, -pwm_right))
     else
-        write(p, BIN1, 0)
-        PiGPIO.set_PWM_dutycycle(p, PWMB_RIGHT, round(Int, pwm_right))
+        digitalWrite(BIN1, LOW)
+        pwmWrite(PWMB_RIGHT, round(Int, pwm_right))
     end
 end
 
 function (@main)(args)::Cint
     println(Core.stdout, "hello world!")
-    p = Pi()
-    println(Core.stdout, "pi startup done")
-    PiGPIO.set_internals(p, 8, 0)
-    println(Core.stdout, "set debug level")
-    handle_err(PiGPIO.hardware_PWM(p, PWMA_LEFT, 1000, 0))
-    handle_err(PiGPIO.hardware_PWM(p, PWMB_RIGHT, 1000, 0)) # use 1kHz pwm for the motor drivers
+
+    # Initialize WiringPi with BCM GPIO numbering
+    wiringPiSetupGpio()
+    println(Core.stdout, "wiringPi startup done")
+
+    # Setup GPIO pins as outputs
+    pinMode(AIN1, OUTPUT)
+    pinMode(BIN1, OUTPUT)
+    pinMode(STBY_PIN, OUTPUT)
+    pinMode(M1A, INPUT)
+    pinMode(M2A, INPUT)
+
+    # Setup hardware PWM on motor pins
+    pinMode(PWMA_LEFT, PWM_OUTPUT)
+    pinMode(PWMB_RIGHT, PWM_OUTPUT)
+    pwmSetMode(PWM_MODE_MS)  # Mark-space mode for motor control
+    pwmSetRange(PWM_RANGE)
+    pwmSetClock(19)  # ~1kHz PWM frequency (19.2MHz / 19 / 1024 ≈ 1kHz)
     println(Core.stdout, "pwm startup done")
-    imu_bus = PiGPIO.i2c_open(p, 1, 0x68)
+
+    # Initialize I2C for IMU (address 0x68)
+    imu_handle = wiringPiI2CSetup(0x68)
+    if imu_handle < 0
+        println(Core.stdout, "Failed to initialize I2C")
+        return 1
+    end
     println(Core.stdout, "i2c startup done")
-    imu = MPU6000(p, imu_bus, GyroRange.GYRO_FS_250, AccelRange.ACCEL_F_2G)
+
+    imu = MPU6000(imu_handle, GyroRange.GYRO_FS_250, AccelRange.ACCEL_F_2G)
     wake!(imu)
     println(Core.stdout, "imu startup done")
     timu = ThreadedMPU6000(imu)
-    tenc_1a = ThreadedEncoder(Encoder(p, M1A), 1_000)
-    tenc_2a = ThreadedEncoder(Encoder(p, M2A), 1_000)
+    tenc_1a = ThreadedEncoder(Encoder(M1A), 1_000)
+    tenc_2a = ThreadedEncoder(Encoder(M2A), 1_000)
 
     ctrl = BalanceController()
 
     ml_update_rate_ns = 50000000
     imu_read_margin = 12600000
     println(Core.stdout, "start loop!")
     now = time_ns()
-    while true 
+    while true
         wait_until(start + ml_update_rate_ns - imu_read_margin)
         put!(timu.request, true) # trigger the IMU request
         wait_until(start + ml_update_rate_ns)
@@ -104,10 +125,10 @@ function (@main)(args)::Cint
                       imu_data.gyro_x, imu_data.gyro_y, imu_data.gyro_z)
         now = time_ns()
         if isnothing(command)
-            car_stop!(p)
-        else 
+            car_stop!()
+        else
             left, right = command
-            apply_motor_output!(p, left, right)
+            apply_motor_output!(left, right)
         end
     end
     return 0
@@ -169,4 +190,4 @@ end
         readcb_specialized(stream_unknown_type, Int(nread), UInt(nrequested))
         nothing
     end
-end
+end