#!/bin/sh
if [ "$1" = "start" ]
then
        . /etc/profile
    echo "usb mode: device"
    cd /sys/kernel/config/usb_gadget

    mkdir g0
    cd g0
    # echo 0x3346 > idVendor
    # echo 0x1009 > idProduct
    # mkdir strings/0x409
    # echo '0123456789ABCDEF' > strings/0x409/serialnumber
    # echo 'sipeed' > strings/0x409/manufacturer
    # echo 'licheervnano' > strings/0x409/product

    echo 0x3346 > idVendor
    echo 0x1009 > idProduct
    mkdir strings/0x409
    echo '0123456789ABCDEF' > strings/0x409/serialnumber
    echo 'flyingrtx' > strings/0x409/manufacturer
    echo 'licheervnano' > strings/0x409/product

    mkdir configs/c.1
    echo 0xE0 > configs/c.1/bmAttributes
    echo 120 > configs/c.1/MaxPower
    mkdir configs/c.1/strings/0x409
    echo "licheervnano" >  configs/c.1/strings/0x409/configuration

#     if [ -e /boot/usb.GS0 ]
#     then
#             mkdir functions/acm.GS0
#             ln -s functions/acm.GS0 configs/c.1/
#     fi
    if [ -e /boot/usb.rndis0 ]
    then
            mkdir functions/rndis.usb0
            ln -s functions/rndis.usb0 configs/c.1/
    fi



    # keyboard
    mkdir functions/hid.GS0
#     echo 1 > functions/hid.GS0/subclass
    echo 1 > functions/hid.GS0/wakeup_on_write
    echo 1 > functions/hid.GS0/protocol
    echo 6 > functions/hid.GS0/report_length
    # echo -ne \\x5\\x1\\x9\\x6\\xa1\\x1\\x5\\x7\\x19\\xe0\\x29\\xe7\\x15\\x0\\x25\\x10\\x75\\x1\\x95\\x8\\x81\\x2\\x95\\x1\\x75\\x8\\x81\\x3\\x95\\x5\\x75\\x1\\x5\\x8\\x19\\x1\\x29\\x5\\x91\\x2\\x95\\x1\\x75\\x3\\x91\\x3\\x95\\x6\\x75\\x8\\x15\\x0\\x25\\x65\\x5\\x7\\x19\\x0\\x29\\x65\\x81\\x0\\xc0 > functions/hid.GS0/report_desc
    echo -ne \\x05\\x01\\x09\\x06\\xa1\\x01\\x05\\x07\\x19\\xe0\\x29\\xe7\\x15\\x00\\x25\\x01\\x75\\x01\\x95\\x08\\x81\\x02\\x95\\x01\\x75\\x08\\x81\\x03\\x95\\x05\\x75\\x01\\x05\\x08\\x19\\x01\\x29\\x05\\x91\\x02\\x95\\x01\\x75\\x03\\x91\\x03\\x95\\x06\\x75\\x08\\x15\\x00\\x25\\x65\\x05\\x07\\x19\\x00\\x29\\x65\\x81\\x00\\xc0 > functions/hid.GS0/report_desc
    ln -s functions/hid.GS0 configs/c.1

    # mouse
    mkdir functions/hid.GS1
    # echo 1 > functions/hid.GS1/subclass
    echo 1 > functions/hid.GS1/wakeup_on_write
    echo 2 > functions/hid.GS1/protocol
    echo -ne \\x34 > functions/hid.GS1/report_length
    echo -ne \\x5\\x1\\x9\\x2\\xa1\\x1\\x9\\x1\\xa1\\x0\\x5\\x9\\x19\\x1\\x29\\x3\\x15\\x0\\x25\\x1\\x95\\x3\\x75\\x1\\x81\\x2\\x95\\x1\\x75\\x5\\x81\\x3\\x5\\x1\\x9\\x30\\x9\\x31\\x9\\x38\\x15\\x81\\x25\\x7f\\x75\\x8\\x95\\x3\\x81\\x6\\xc0\\xc0 > functions/hid.GS1/report_desc        
    ln -s functions/hid.GS1 configs/c.1

    # touchpad
    mkdir functions/hid.GS2
    # echo 1 > functions/hid.GS2/subclass
    echo 1 > functions/hid.GS2/wakeup_on_write
    echo 2 > functions/hid.GS2/protocol
    echo 6 > functions/hid.GS2/report_length
    echo -ne \\x05\\x01\\x09\\x02\\xa1\\x01\\x09\\x01\\xa1\\x00\\x05\\x09\\x19\\x01\\x29\\x03\\x15\\x00\\x25\\x01\\x95\\x03\\x75\\x01\\x81\\x02\\x95\\x01\\x75\\x05\\x81\\x01\\x05\\x01\\x09\\x30\\x09\\x31\\x15\\x00\\x26\\xff\\x7f\\x35\\x00\\x46\\xff\\x7f\\x75\\x10\\x95\\x02\\x81\\x02\\x05\\x01\\x09\\x38\\x15\\x81\\x25\\x7f\\x35\\x00\\x45\\x00\\x75\\x08\\x95\\x01\\x81\\x06\\xc0\\xc0 > functions/hid.GS2/report_desc
    ln -s functions/hid.GS2 configs/c.1

        if [ -e /boot/usb.disk0 ]
        then
                mkdir functions/mass_storage.disk0
                ln -s functions/mass_storage.disk0 configs/c.1/
                echo 1 > functions/mass_storage.disk0/lun.0/removable
                if [ -e /boot/usb.disk0.ro ]
                then
                        echo 1 > functions/mass_storage.disk0/lun.0/ro
                        echo 0 > functions/mass_storage.disk0/lun.0/cdrom
                fi
                disk=$(cat /boot/usb.disk0)
                if [ -z "${disk}" ]
                then
                        # if [ ! -e /mnt/usbdisk.img ]
                        # then
                        #         fallocate -l 8G /mnt/usbdisk.img
                        #         mkfs.vfat /mnt/usbdisk.img
                        # fi
                        echo /dev/mmcblk0p3 > functions/mass_storage.disk0/lun.0/file
                else
                        cat /boot/usb.disk0 > functions/mass_storage.disk0/lun.0/file
                fi
        fi

    ls /sys/class/udc/ | cat > UDC
    echo device > /proc/cviusb/otg_role
fi

if [ "$1" = "stop" ]
then
        echo '' > /sys/kernel/config/usb_gadget/g0/UDC
        echo host > /proc/cviusb/otg_role
fi
