--- /dev/null
+ GNU GENERAL PUBLIC LICENSE
+ Version 2, June 1991
+
+ Copyright (C) 1989, 1991 Free Software Foundation, Inc.
+ 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
+ Everyone is permitted to copy and distribute verbatim copies
+ of this license document, but changing it is not allowed.
+
+ Preamble
+
+ The licenses for most software are designed to take away your
+freedom to share and change it. By contrast, the GNU General Public
+License is intended to guarantee your freedom to share and change free
+software--to make sure the software is free for all its users. This
+General Public License applies to most of the Free Software
+Foundation's software and to any other program whose authors commit to
+using it. (Some other Free Software Foundation software is covered by
+the GNU Library General Public License instead.) You can apply it to
+your programs, too.
+
+ When we speak of free software, we are referring to freedom, not
+price. Our General Public Licenses are designed to make sure that you
+have the freedom to distribute copies of free software (and charge for
+this service if you wish), that you receive source code or can get it
+if you want it, that you can change the software or use pieces of it
+in new free programs; and that you know you can do these things.
+
+ To protect your rights, we need to make restrictions that forbid
+anyone to deny you these rights or to ask you to surrender the rights.
+These restrictions translate to certain responsibilities for you if you
+distribute copies of the software, or if you modify it.
+
+ For example, if you distribute copies of such a program, whether
+gratis or for a fee, you must give the recipients all the rights that
+you have. You must make sure that they, too, receive or can get the
+source code. And you must show them these terms so they know their
+rights.
+
+ We protect your rights with two steps: (1) copyright the software, and
+(2) offer you this license which gives you legal permission to copy,
+distribute and/or modify the software.
+
+ Also, for each author's protection and ours, we want to make certain
+that everyone understands that there is no warranty for this free
+software. If the software is modified by someone else and passed on, we
+want its recipients to know that what they have is not the original, so
+that any problems introduced by others will not reflect on the original
+authors' reputations.
+
+ Finally, any free program is threatened constantly by software
+patents. We wish to avoid the danger that redistributors of a free
+program will individually obtain patent licenses, in effect making the
+program proprietary. To prevent this, we have made it clear that any
+patent must be licensed for everyone's free use or not licensed at all.
+
+ The precise terms and conditions for copying, distribution and
+modification follow.
+
+ GNU GENERAL PUBLIC LICENSE
+ TERMS AND CONDITIONS FOR COPYING, DISTRIBUTION AND MODIFICATION
+
+ 0. This License applies to any program or other work which contains
+a notice placed by the copyright holder saying it may be distributed
+under the terms of this General Public License. The "Program", below,
+refers to any such program or work, and a "work based on the Program"
+means either the Program or any derivative work under copyright law:
+that is to say, a work containing the Program or a portion of it,
+either verbatim or with modifications and/or translated into another
+language. (Hereinafter, translation is included without limitation in
+the term "modification".) Each licensee is addressed as "you".
+
+Activities other than copying, distribution and modification are not
+covered by this License; they are outside its scope. The act of
+running the Program is not restricted, and the output from the Program
+is covered only if its contents constitute a work based on the
+Program (independent of having been made by running the Program).
+Whether that is true depends on what the Program does.
+
+ 1. You may copy and distribute verbatim copies of the Program's
+source code as you receive it, in any medium, provided that you
+conspicuously and appropriately publish on each copy an appropriate
+copyright notice and disclaimer of warranty; keep intact all the
+notices that refer to this License and to the absence of any warranty;
+and give any other recipients of the Program a copy of this License
+along with the Program.
+
+You may charge a fee for the physical act of transferring a copy, and
+you may at your option offer warranty protection in exchange for a fee.
+
+ 2. You may modify your copy or copies of the Program or any portion
+of it, thus forming a work based on the Program, and copy and
+distribute such modifications or work under the terms of Section 1
+above, provided that you also meet all of these conditions:
+
+ a) You must cause the modified files to carry prominent notices
+ stating that you changed the files and the date of any change.
+
+ b) You must cause any work that you distribute or publish, that in
+ whole or in part contains or is derived from the Program or any
+ part thereof, to be licensed as a whole at no charge to all third
+ parties under the terms of this License.
+
+ c) If the modified program normally reads commands interactively
+ when run, you must cause it, when started running for such
+ interactive use in the most ordinary way, to print or display an
+ announcement including an appropriate copyright notice and a
+ notice that there is no warranty (or else, saying that you provide
+ a warranty) and that users may redistribute the program under
+ these conditions, and telling the user how to view a copy of this
+ License. (Exception: if the Program itself is interactive but
+ does not normally print such an announcement, your work based on
+ the Program is not required to print an announcement.)
+
+These requirements apply to the modified work as a whole. If
+identifiable sections of that work are not derived from the Program,
+and can be reasonably considered independent and separate works in
+themselves, then this License, and its terms, do not apply to those
+sections when you distribute them as separate works. But when you
+distribute the same sections as part of a whole which is a work based
+on the Program, the distribution of the whole must be on the terms of
+this License, whose permissions for other licensees extend to the
+entire whole, and thus to each and every part regardless of who wrote it.
+
+Thus, it is not the intent of this section to claim rights or contest
+your rights to work written entirely by you; rather, the intent is to
+exercise the right to control the distribution of derivative or
+collective works based on the Program.
+
+In addition, mere aggregation of another work not based on the Program
+with the Program (or with a work based on the Program) on a volume of
+a storage or distribution medium does not bring the other work under
+the scope of this License.
+
+ 3. You may copy and distribute the Program (or a work based on it,
+under Section 2) in object code or executable form under the terms of
+Sections 1 and 2 above provided that you also do one of the following:
+
+ a) Accompany it with the complete corresponding machine-readable
+ source code, which must be distributed under the terms of Sections
+ 1 and 2 above on a medium customarily used for software interchange; or,
+
+ b) Accompany it with a written offer, valid for at least three
+ years, to give any third party, for a charge no more than your
+ cost of physically performing source distribution, a complete
+ machine-readable copy of the corresponding source code, to be
+ distributed under the terms of Sections 1 and 2 above on a medium
+ customarily used for software interchange; or,
+
+ c) Accompany it with the information you received as to the offer
+ to distribute corresponding source code. (This alternative is
+ allowed only for noncommercial distribution and only if you
+ received the program in object code or executable form with such
+ an offer, in accord with Subsection b above.)
+
+The source code for a work means the preferred form of the work for
+making modifications to it. For an executable work, complete source
+code means all the source code for all modules it contains, plus any
+associated interface definition files, plus the scripts used to
+control compilation and installation of the executable. However, as a
+special exception, the source code distributed need not include
+anything that is normally distributed (in either source or binary
+form) with the major components (compiler, kernel, and so on) of the
+operating system on which the executable runs, unless that component
+itself accompanies the executable.
+
+If distribution of executable or object code is made by offering
+access to copy from a designated place, then offering equivalent
+access to copy the source code from the same place counts as
+distribution of the source code, even though third parties are not
+compelled to copy the source along with the object code.
+
+ 4. You may not copy, modify, sublicense, or distribute the Program
+except as expressly provided under this License. Any attempt
+otherwise to copy, modify, sublicense or distribute the Program is
+void, and will automatically terminate your rights under this License.
+However, parties who have received copies, or rights, from you under
+this License will not have their licenses terminated so long as such
+parties remain in full compliance.
+
+ 5. You are not required to accept this License, since you have not
+signed it. However, nothing else grants you permission to modify or
+distribute the Program or its derivative works. These actions are
+prohibited by law if you do not accept this License. Therefore, by
+modifying or distributing the Program (or any work based on the
+Program), you indicate your acceptance of this License to do so, and
+all its terms and conditions for copying, distributing or modifying
+the Program or works based on it.
+
+ 6. Each time you redistribute the Program (or any work based on the
+Program), the recipient automatically receives a license from the
+original licensor to copy, distribute or modify the Program subject to
+these terms and conditions. You may not impose any further
+restrictions on the recipients' exercise of the rights granted herein.
+You are not responsible for enforcing compliance by third parties to
+this License.
+
+ 7. If, as a consequence of a court judgment or allegation of patent
+infringement or for any other reason (not limited to patent issues),
+conditions are imposed on you (whether by court order, agreement or
+otherwise) that contradict the conditions of this License, they do not
+excuse you from the conditions of this License. If you cannot
+distribute so as to satisfy simultaneously your obligations under this
+License and any other pertinent obligations, then as a consequence you
+may not distribute the Program at all. For example, if a patent
+license would not permit royalty-free redistribution of the Program by
+all those who receive copies directly or indirectly through you, then
+the only way you could satisfy both it and this License would be to
+refrain entirely from distribution of the Program.
+
+If any portion of this section is held invalid or unenforceable under
+any particular circumstance, the balance of the section is intended to
+apply and the section as a whole is intended to apply in other
+circumstances.
+
+It is not the purpose of this section to induce you to infringe any
+patents or other property right claims or to contest validity of any
+such claims; this section has the sole purpose of protecting the
+integrity of the free software distribution system, which is
+implemented by public license practices. Many people have made
+generous contributions to the wide range of software distributed
+through that system in reliance on consistent application of that
+system; it is up to the author/donor to decide if he or she is willing
+to distribute software through any other system and a licensee cannot
+impose that choice.
+
+This section is intended to make thoroughly clear what is believed to
+be a consequence of the rest of this License.
+
+ 8. If the distribution and/or use of the Program is restricted in
+certain countries either by patents or by copyrighted interfaces, the
+original copyright holder who places the Program under this License
+may add an explicit geographical distribution limitation excluding
+those countries, so that distribution is permitted only in or among
+countries not thus excluded. In such case, this License incorporates
+the limitation as if written in the body of this License.
+
+ 9. The Free Software Foundation may publish revised and/or new versions
+of the General Public License from time to time. Such new versions will
+be similar in spirit to the present version, but may differ in detail to
+address new problems or concerns.
+
+Each version is given a distinguishing version number. If the Program
+specifies a version number of this License which applies to it and "any
+later version", you have the option of following the terms and conditions
+either of that version or of any later version published by the Free
+Software Foundation. If the Program does not specify a version number of
+this License, you may choose any version ever published by the Free Software
+Foundation.
+
+ 10. If you wish to incorporate parts of the Program into other free
+programs whose distribution conditions are different, write to the author
+to ask for permission. For software which is copyrighted by the Free
+Software Foundation, write to the Free Software Foundation; we sometimes
+make exceptions for this. Our decision will be guided by the two goals
+of preserving the free status of all derivatives of our free software and
+of promoting the sharing and reuse of software generally.
+
+ NO WARRANTY
+
+ 11. BECAUSE THE PROGRAM IS LICENSED FREE OF CHARGE, THERE IS NO WARRANTY
+FOR THE PROGRAM, TO THE EXTENT PERMITTED BY APPLICABLE LAW. EXCEPT WHEN
+OTHERWISE STATED IN WRITING THE COPYRIGHT HOLDERS AND/OR OTHER PARTIES
+PROVIDE THE PROGRAM "AS IS" WITHOUT WARRANTY OF ANY KIND, EITHER EXPRESSED
+OR IMPLIED, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE. THE ENTIRE RISK AS
+TO THE QUALITY AND PERFORMANCE OF THE PROGRAM IS WITH YOU. SHOULD THE
+PROGRAM PROVE DEFECTIVE, YOU ASSUME THE COST OF ALL NECESSARY SERVICING,
+REPAIR OR CORRECTION.
+
+ 12. IN NO EVENT UNLESS REQUIRED BY APPLICABLE LAW OR AGREED TO IN WRITING
+WILL ANY COPYRIGHT HOLDER, OR ANY OTHER PARTY WHO MAY MODIFY AND/OR
+REDISTRIBUTE THE PROGRAM AS PERMITTED ABOVE, BE LIABLE TO YOU FOR DAMAGES,
+INCLUDING ANY GENERAL, SPECIAL, INCIDENTAL OR CONSEQUENTIAL DAMAGES ARISING
+OUT OF THE USE OR INABILITY TO USE THE PROGRAM (INCLUDING BUT NOT LIMITED
+TO LOSS OF DATA OR DATA BEING RENDERED INACCURATE OR LOSSES SUSTAINED BY
+YOU OR THIRD PARTIES OR A FAILURE OF THE PROGRAM TO OPERATE WITH ANY OTHER
+PROGRAMS), EVEN IF SUCH HOLDER OR OTHER PARTY HAS BEEN ADVISED OF THE
+POSSIBILITY OF SUCH DAMAGES.
+
+ END OF TERMS AND CONDITIONS
+
+ How to Apply These Terms to Your New Programs
+
+ If you develop a new program, and you want it to be of the greatest
+possible use to the public, the best way to achieve this is to make it
+free software which everyone can redistribute and change under these terms.
+
+ To do so, attach the following notices to the program. It is safest
+to attach them to the start of each source file to most effectively
+convey the exclusion of warranty; and each file should have at least
+the "copyright" line and a pointer to where the full notice is found.
+
+ <one line to give the program's name and a brief idea of what it does.>
+ Copyright (C) <year> <name of author>
+
+ This program is free software; you can redistribute it and/or modify
+ it under the terms of the GNU General Public License as published by
+ the Free Software Foundation; either version 2 of the License, or
+ (at your option) any later version.
+
+ This program is distributed in the hope that it will be useful,
+ but WITHOUT ANY WARRANTY; without even the implied warranty of
+ MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ GNU General Public License for more details.
+
+ You should have received a copy of the GNU General Public License
+ along with this program; if not, write to the Free Software
+ Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
+
+
+Also add information on how to contact you by electronic and paper mail.
+
+If the program is interactive, make it output a short notice like this
+when it starts in an interactive mode:
+
+ Gnomovision version 69, Copyright (C) year name of author
+ Gnomovision comes with ABSOLUTELY NO WARRANTY; for details type `show w'.
+ This is free software, and you are welcome to redistribute it
+ under certain conditions; type `show c' for details.
+
+The hypothetical commands `show w' and `show c' should show the appropriate
+parts of the General Public License. Of course, the commands you use may
+be called something other than `show w' and `show c'; they could even be
+mouse-clicks or menu items--whatever suits your program.
+
+You should also get your employer (if you work as a programmer) or your
+school, if any, to sign a "copyright disclaimer" for the program, if
+necessary. Here is a sample; alter the names:
+
+ Yoyodyne, Inc., hereby disclaims all copyright interest in the program
+ `Gnomovision' (which makes passes at compilers) written by James Hacker.
+
+ <signature of Ty Coon>, 1 April 1989
+ Ty Coon, President of Vice
+
+This General Public License does not permit incorporating your program into
+proprietary programs. If your program is a subroutine library, you may
+consider it more useful to permit linking proprietary applications with the
+library. If this is what you want to do, use the GNU Library General
+Public License instead of this License.
GPIO144 DRDY signal from PIC24@CPU2010
SPI2 AD data receive and CMD send for PIC24@CPU2010
+
+ **** Ver1.1 2016/2
+ * kernel3.18対応
+ * kernel3.18用に変更した他のspike-adを参考にして変更した
+ * makeではなくbitbakeでbuildするように変更した
+ * SPI速度を500KHz->50KHzに変更
+ * bus_find_device_by_name()で見つけたデバイスをdevice_del()で取り除くようにした
+ *
+ * Make方法
+ * $ cd dev/overo-yocto-2015/
+ * $ . poky/oe-init-build-env
+ * $ bitbake spike-ad
Copyright Naoya Takamura, 2011
This program based on spike.c
+
---------------------------------------------
spike.c
Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
*/
+#include <linux/kernel.h> /* We're doing kernel work */
+#include <linux/module.h> /* Specifically, a module */
#include <linux/init.h>
-#include <linux/module.h>
#include <linux/fs.h>
#include <linux/device.h>
#include <linux/mutex.h>
#include <linux/wait.h>
#include <linux/sched.h>
#include <asm/atomic.h>
+#include <asm/irq.h>
+#include <linux/hrtimer.h>
#include "spike-ad.h"
#define SPI_BUS 1
#define SPI_BUS_CS0 0
-#define SPI_BUS_SPEED 500000 // Hz
+//#define SPI_BUS_SPEED 500000 // Hz 2us/bit
+#define SPI_BUS_SPEED 50000 // Hz 20us/bit
#define SPI_DATA_SIZE (965+1) // $含む PICから受信するデータ長 DMA問題のために+1byteしている
#define GPIO_TOGGLE_OUT 145 // Debug用toggle出力 = GPIO145
#endif
+// SPI受信タイムアウト用タイマ
+#define SPI_TIMEOUT_SEC 3
+#define SPI_TIMEOUT_NS 0
+
/**** 注意！ Version */
-#define VERSION "1.0"
-#define MODULE_NAME "spike-ad"
+#define VERSION "1.1"
+#define MODULE_NAME "spikead"
const char this_driver_name[] = MODULE_NAME;
struct class *class;
struct spi_device *spi_device;
char *user_buff;
-// u8 test_data;
+ struct hrtimer timer;
};
static struct spike_dev spike_dev;
typedef struct {
unsigned long f_version; // 識別用 f_version
wait_queue_head_t wait; /* read and write queues */
+ struct semaphore finfo_sem;
int sleep_mode; // 0: 起きてる 1: 待ち
- int intflag; // 割り込みフラグ 1=割り込み入った
} FileInfo;
static FileInfo finfo;
-
-void spike_tasklet_func(unsigned long data);
-DECLARE_TASKLET(spike_tasklet, spike_tasklet_func, 0);
-
//
/**** SPI受信データ リングバッファ ******************************************
*/
return 0;
}
-
+//
+/**** SPI受信終了ハンドラ ******************************************
+ */
/*
- spike_queue_spi_write()で開始した
- spi_async()終了後に呼ばれる
- つまりSPIでデータを受信完了した状態
+ SPI受信 Completion Handlerでスケジュールされるタスクレット関数
+ SPI受信データ処理をする
*/
-static void spike_spi_completion_handler(void *arg)
+void spike_spi_completion_tasklet_func(unsigned long arg)
+{
+//printk(KERN_INFO MODULE_NAME" %s\n", __FUNCTION__);
+ // ここatomic spike_ctl
+ if (down_interruptible(&spike_ctl.cmd_sem)) {
+ return;
+ }
+ spike_ctl.busy = 0;
+ spike_ctl.spi_callbacks++;
+ up(&spike_ctl.cmd_sem);
+ // ここatomic finfo
+ if (down_interruptible(&finfo.finfo_sem)) {
+ return;
+ }
+ // 寝ているものを起こす
+ if (finfo.sleep_mode) {
+ // 待ちを
+ wake_up_interruptible(&(finfo.wait)); // 起こす
+ //printk(KERN_INFO "intsel_interrupt: wakeup %ld\n", fi[i].f_version);
+ // この間でpoll()でsleep_mode=1になるとまずいのでセマフォで保護している。
+ finfo.sleep_mode = 0;
+ }
+ up(&finfo.finfo_sem);
+}
+// タスクレット宣言
+DECLARE_TASKLET(spike_spi_completion_tasklet, spike_spi_completion_tasklet_func, 0);
+/*
+ SPI受信 Completion Handler
+ spike_queue_spi_write()で開始したspi_async()終了後に呼ばれる
+ つまりSPIでデータを受信完了すると呼ばれる
+ Sleep禁止
+ */
+void spike_spi_completion_handler(void *arg)
{
unsigned char *p;
memcpy(p, spike_ctl.rx_buff, SPI_DATA_SIZE);
// 実際に受信できたデータ長
spike_ctl.received_len = spike_ctl.msg.actual_length;
-
// 書き込み位置進める
ring_write_plus();
- // 寝ているものを起こす
- if (finfo.sleep_mode) {
- // 待ちを
- wake_up_interruptible(&(finfo.wait)); // 起こす
-//printk(KERN_INFO "intsel_interrupt: wakeup %ld\n", fi[i].f_version);
- finfo.sleep_mode = 0;
- finfo.intflag = 1;
- }
+ // SPI受信タイムアウトタイマ停止
+ hrtimer_cancel(&spike_dev.timer);
+ // DRDY割り込みON
+ // ココでONにするとGPS受信状態が悪い時などにctrl.busy=1のまま割り込みが入ってしまう可能性があるが、busyは参照していないので良しとする
+ enable_irq(spike_ctl.irq);
+
+ // 後はタスクレットに任せる
+ tasklet_hi_schedule(&spike_spi_completion_tasklet);
}
+//
+/**** DRDY割り込み関係 ******************************************
+ */
/*
- spi_async()で送信開始
+ タスクレットから呼ばれる
+ spi_async()で送信開始する
受信データはcallback funcで受ける
*/
static int spike_queue_spi_write(void)
int status;
unsigned long flags;
- // struct spi_messageを初期化 ゼロクリア
- spi_message_init(&spike_ctl.msg);
+//printk(KERN_INFO MODULE_NAME" %s\n", __FUNCTION__);
- // Callback関数設定
- spike_ctl.msg.complete = spike_spi_completion_handler;
- spike_ctl.msg.context = NULL;
-
- memset(spike_ctl.tx_buff, 0, SPI_BUFF_SIZE);
- memset(spike_ctl.rx_buff, 0, SPI_BUFF_SIZE);
-
- if (down_interruptible(&spike_ctl.cmd_sem))
+// ここatomic spike_ctl
+ if (down_interruptible(&spike_ctl.cmd_sem)) {
return -ERESTARTSYS;
+ }
+ // struct spi_messageを初期化 ゼロクリア
+ spi_message_init(&spike_ctl.msg);
+ // Callback関数設定
+ spike_ctl.msg.complete = spike_spi_completion_handler;
+ spike_ctl.msg.context = NULL;
+ memset(spike_ctl.tx_buff, 0, SPI_BUFF_SIZE);
+ memset(spike_ctl.rx_buff, 0, SPI_BUFF_SIZE);
// TXコマンドセット
memcpy(spike_ctl.tx_buff, spike_ctl.cmd_buf, spike_ctl.cmd_len);
// TXコマンドクリア
memset(spike_ctl.cmd_buf, 0, SPI_CMD_MAX);
- up(&spike_ctl.cmd_sem);
+ spike_ctl.transfer.tx_buf = spike_ctl.tx_buff;
+ spike_ctl.transfer.rx_buf = spike_ctl.rx_buff;
+ spike_ctl.transfer.len = SPI_DATA_SIZE;
- spike_ctl.transfer.tx_buf = spike_ctl.tx_buff;
- spike_ctl.transfer.rx_buf = spike_ctl.rx_buff;
- spike_ctl.transfer.len = SPI_DATA_SIZE;
+ spi_message_add_tail(&spike_ctl.transfer, &spike_ctl.msg);
+ up(&spike_ctl.cmd_sem);
+ // ここまでatomic
- spi_message_add_tail(&spike_ctl.transfer, &spike_ctl.msg);
+ // DRDY割り込みOFF
+ // PICのバッファにデータがあるとSPI受信中に再度DRDYがLowになり割り込みがかかってしまうため
+ disable_irq(spike_ctl.irq);
+ // SpinLock
spin_lock_irqsave(&spike_dev.spi_lock, flags);
-
- if (spike_dev.spi_device)
- status = spi_async(spike_dev.spi_device, &spike_ctl.msg);
- else
- status = -ENODEV;
-
+ // SPI送受信開始
+ if (spike_dev.spi_device)
+ status = spi_async(spike_dev.spi_device, &spike_ctl.msg);
+ else
+ status = -ENODEV;
spin_unlock_irqrestore(&spike_dev.spi_lock, flags);
- if (status == 0)
+ if (status == 0) {
spike_ctl.busy = 1;
-
+ // SPI受信タイムアウトタイマスタート
+ hrtimer_start(&spike_dev.timer,
+ ktime_set(SPI_TIMEOUT_SEC, SPI_TIMEOUT_NS),
+ HRTIMER_MODE_REL);
+ return status;
+ }
+
+ // SPIがエラーなのでDRDY割り込みONに戻す
+ enable_irq(spike_ctl.irq);
+ switch(status) {
+ case -ENODEV:
+ printk(KERN_WARNING "%s %s spi_async()=ENODEV\n", MODULE_NAME, __FUNCTION__);
+ break;
+ case -EBUSY:
+ printk(KERN_WARNING "%s %s spi_async()=EBUSY\n", MODULE_NAME, __FUNCTION__);
+ break;
+ case -EINVAL:
+ printk(KERN_WARNING "%s %s spi_async()=EINVAL\n", MODULE_NAME, __FUNCTION__);
+ break;
+ default:
+ printk(KERN_WARNING "%s %s spi_async()=%d\n", MODULE_NAME, __FUNCTION__, status);
+ break;
+ }
return status;
}
/*
- Tasklet
- IRQ Handlerで呼び出される
+ タスクレット
+ IRQ Handlerã\81§å\91¼ã\81³å\87ºã\81\97ã\81\8cã\82¹ã\82±ã\82¸ã\83¥ã\83¼ã\83«ã\81\95ã\82\8cã\82\8b
SPI送受信を開始する
*/
void spike_tasklet_func(unsigned long data)
{
int status;
+//printk(KERN_INFO "%s %s()\n", MODULE_NAME, __FUNCTION__);
// SPI送受信開始
status = spike_queue_spi_write();
if (status) {
// error
+ printk(KERN_ERR "%s %s spike_queue_spi_write()=%d\n", MODULE_NAME, __FUNCTION__, status);
} else {
// ok
}
}
+// タスクレット宣言
+DECLARE_TASKLET(spike_tasklet, spike_tasklet_func, 0);
/*
- DRDY Interrupt Handler
+ DRDY 割り込みハンドラ
*/
static irqreturn_t irq_handler(int irq, void *dev_id)
{
}
#endif
// タスクレットにまかせる
- tasklet_schedule(&spike_tasklet);
+ tasklet_hi_schedule(&spike_tasklet);
return IRQ_HANDLED;
}
-#if 0
-static ssize_t spike_file_read(struct file *filp, char __user *buff, size_t count,
- loff_t *offp)
+//
+/**** High Res. Timer Callback *****************************************
+ * SPI受信が正常に終了しなかった場合にタイムアウトで呼ばれる
+ * DRDY割り込みを有効にする
+ */
+static enum hrtimer_restart spike_timer_callback(struct hrtimer *timer)
{
- size_t len;
- ssize_t status = 0;
-
- if (!buff)
- return -EFAULT;
-
- if (*offp > 0)
- return 0;
-
- if (down_interruptible(&spike_dev.fop_sem))
- return -ERESTARTSYS;
-
-if (spike_ctl.busy) {
- sprintf(spike_dev.user_buff, "spike_ctl.busy==1\n");
- count = strlen(spike_dev.user_buff);
- up(&spike_dev.fop_sem);
- return count;
-} else {
-//sprintf(spike_dev.user_buff, "DMA\n");
-
- sprintf(spike_dev.user_buff,
- "Status: %d\nTX: %d %d %d %d\nRX: %d %d %d %d %d %d %d %d %d %d %d %d %d %d %d %d\nCallback=%d DRDY=%d\n",
- spike_ctl.msg.status,
- spike_ctl.tx_buff[0], spike_ctl.tx_buff[1],
- spike_ctl.tx_buff[2], spike_ctl.tx_buff[3],
- spike_ctl.rx_buff[0], spike_ctl.rx_buff[1],
- spike_ctl.rx_buff[2], spike_ctl.rx_buff[3],
- spike_ctl.rx_buff[4], spike_ctl.rx_buff[5],
- spike_ctl.rx_buff[6], spike_ctl.rx_buff[7],
- spike_ctl.rx_buff[8], spike_ctl.rx_buff[9],
- spike_ctl.rx_buff[10], spike_ctl.rx_buff[11],
- spike_ctl.rx_buff[12], spike_ctl.rx_buff[13],
- spike_ctl.rx_buff[14], spike_ctl.rx_buff[15],
- spike_ctl.spi_callbacks, gpio_get_value(GPIO_DRDY_IN));
-
-}
-// status = spike_do_one_message();
-//status = spike_send_cmd();
-//status = spike_rcv_data();
-
-#if 0
-// SPI送受信開始
-status = spike_queue_spi_write();
-
- if (status) {
- sprintf(spike_dev.user_buff,
- "spike_do_one_message failed : %d\n",
- status);
- }
- else {
+ // DRDY割り込みON
+ if (spike_ctl.irq > 0) {
+ enable_irq(spike_ctl.irq);
}
-#endif
-
- len = strlen(spike_dev.user_buff);
-
- if (len < count)
- count = len;
-
- if (copy_to_user(buff, spike_dev.user_buff, count)) {
- printk(KERN_ALERT "spike_read(): copy_to_user() failed\n");
- status = -EFAULT;
- } else {
- *offp += count;
- status = count;
- }
-
- up(&spike_dev.fop_sem);
-
- return status;
+ printk(KERN_WARNING "%s %s spi rcv timeout\n", MODULE_NAME, __FUNCTION__);
+//printk(KERN_INFO "timer!\n");
+ return HRTIMER_NORESTART;
}
-#endif
-
+//
+/**** spike file operation *******************************************
+ * デバイスファイル操作関係
+ */
+// OPEN
static int spike_file_open(struct inode *inode, struct file *filp)
{
int status = 0;
if (down_interruptible(&spike_dev.fop_sem))
return -ERESTARTSYS;
- if (!spike_dev.user_buff) {
- spike_dev.user_buff = kmalloc(USER_BUFF_SIZE, GFP_KERNEL);
- if (!spike_dev.user_buff)
- status = -ENOMEM;
- }
-
- if (finfo.f_version != 0) {
- printk(KERN_INFO "spike_open: busy\n");
- return -EBUSY;
- }
+ if (!spike_dev.user_buff) {
+ spike_dev.user_buff = kmalloc(USER_BUFF_SIZE, GFP_KERNEL);
+ if (!spike_dev.user_buff)
+ status = -ENOMEM;
+ }
- finfo.f_version = filp->f_version;
- finfo.sleep_mode = 0;
- finfo.intflag = 0;
- init_waitqueue_head(&(finfo.wait));
- filp->private_data = (void*)&finfo; // プライベートデータに構造体ポインタ設定
+ if (finfo.f_version != 0) {
+ printk(KERN_INFO "spike_open: busy\n");
+ up(&spike_dev.fop_sem);
+ return -EBUSY;
+ }
- ring_clear();
+ finfo.f_version = filp->f_version;
+ finfo.sleep_mode = 0;
+ init_waitqueue_head(&(finfo.wait));
+ filp->private_data = (void*)&finfo; // プライベートデータに構造体ポインタ設定
up(&spike_dev.fop_sem);
+ spike_ctl.busy = 0;
+
+ ring_clear();
+
return status;
}
-
+// CLOSE
static int spike_file_close(struct inode * inode, struct file * file)
{
// printk(KERN_INFO "spike_close: (%Lu)\n",file->f_version);
((FileInfo *)(file->private_data))->f_version = 0;
((FileInfo *)(file->private_data))->sleep_mode = 0;
- ((FileInfo *)(file->private_data))->intflag = 0;
return 0;
}
-
+/*
+ * poll
+ */
static unsigned int spike_file_poll(struct file *file, struct poll_table_struct *ptab)
{
//printk(KERN_INFO "spike_file_poll: (%ld)\n",file->f_version);
- // 割り込み入っている
- if ( ((FileInfo *)(file->private_data))->intflag ) {
- // フラグクリア
- ((FileInfo *)(file->private_data))->intflag = 0;
-//printk(KERN_INFO "spike_file_poll: (%ld) interrupted\n",file->f_version);
- return POLLIN | POLLRDNORM; // 読み込みOK
- }
- // 割り込み入っていないので待ち行列に追加する 割り込みハンドラが起こす
- poll_wait(file, &(((FileInfo *)(file->private_data))->wait), ptab);
-//printk(KERN_INFO "spike_file_poll: (%ld) poll_wait\n",file->f_version);
- // sleep_mode=寝ている
- ((FileInfo *)(file->private_data))->sleep_mode = 1;
+ // atomicにしておく
+ if (down_interruptible(&finfo.finfo_sem))
+ return -ERESTARTSYS;
+
+ // ringバッファにデータがあれば
+ if (ring_num_get() > 0) {
+ up(&finfo.finfo_sem);
+ return POLLIN | POLLRDNORM; // 読み込みOK
+ }
+ // ココで割り込みが入ってspike_spi_completion_handler()でring write位置が進むとまずい
+
+ // 待ち行列に追加する 割り込みハンドラが起こす
+ poll_wait(file, &(((FileInfo *)(file->private_data))->wait), ptab);
+ //printk(KERN_INFO "spike_file_poll: (%ld) poll_wait\n",file->f_version);
+
+ // sleep_mode=寝ている
+ ((FileInfo *)(file->private_data))->sleep_mode = 1;
+
+ up(&finfo.finfo_sem);
return 0;
}
-
+/*
+ * ioctl
+ */
static long spike_file_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
{
int i;
switch(cmd) {
// SPI送信データ長セット
case CMD_TX_LEN:
- if (down_interruptible(&spike_ctl.cmd_sem))
+ // atomic spike_ctl
+ if (down_interruptible(&spike_ctl.cmd_sem)) {
return -ERESTARTSYS;
- if (copy_from_user(&spike_ctl.cmd_len, (void *)arg, sizeof(int))) {
- printk(KERN_ALERT "spike_file_ioctl(): copy_from_user() failed\n");
- up(&spike_ctl.cmd_sem);
- return -EFAULT;
}
-//printk(KERN_INFO "spike_file_ioctl: CMD_TX_LEN %d\n", spike_ctl.cmd_len);
- if (spike_ctl.cmd_len > SPI_CMD_MAX) spike_ctl.cmd_len = SPI_CMD_MAX;
+ if (copy_from_user(&spike_ctl.cmd_len, (void *)arg, sizeof(int))) {
+ printk(KERN_ALERT "spike_file_ioctl(): copy_from_user() failed\n");
+ up(&spike_ctl.cmd_sem);
+ return -EFAULT;
+ }
+ //printk(KERN_INFO "spike_file_ioctl: CMD_TX_LEN %d\n", spike_ctl.cmd_len);
+ if (spike_ctl.cmd_len > SPI_CMD_MAX) spike_ctl.cmd_len = SPI_CMD_MAX;
up(&spike_ctl.cmd_sem);
return 0;
// SPI送信データセット
case CMD_TX_SET:
- if (down_interruptible(&spike_ctl.cmd_sem))
+ // atomic spike_ctl
+ if (down_interruptible(&spike_ctl.cmd_sem)) {
return -ERESTARTSYS;
- if (copy_from_user(&spike_ctl.cmd_buf, (void *)arg, spike_ctl.cmd_len)) {
- printk(KERN_ALERT "spike_file_ioctl(): copy_from_user() failed\n");
- up(&spike_ctl.cmd_sem);
- return -EFAULT;
}
+ if (copy_from_user(&spike_ctl.cmd_buf, (void *)arg, spike_ctl.cmd_len)) {
+ printk(KERN_ALERT "spike_file_ioctl(): copy_from_user() failed\n");
+ up(&spike_ctl.cmd_sem);
+ return -EFAULT;
+ }
//printk(KERN_INFO "spike_file_ioctl: CMD_TX_SET %02X %02X %02X %02X\n", spike_ctl.cmd_buf[0], spike_ctl.cmd_buf[1], spike_ctl.cmd_buf[2], spike_ctl.cmd_buf[3]);
up(&spike_ctl.cmd_sem);
return 0;
return 0;
}
}
-
+// File Operation構造体初期化
static const struct file_operations spike_fops = {
.owner = THIS_MODULE,
// .read = spike_file_read,
.poll = spike_file_poll,
.unlocked_ioctl = spike_file_ioctl,
};
-
-
-static int spike_probe(struct spi_device *spi_device)
+//
+/**** spi device operation *******************************************
+ */
+static int spike_probe(struct spi_device *spi)
{
unsigned long flags;
+printk(KERN_INFO "%s %s() bus=%d,cs=%d\n", MODULE_NAME, __FUNCTION__, spi->master->bus_num, spi->chip_select);
+
+ // SpinLock
spin_lock_irqsave(&spike_dev.spi_lock, flags);
- spike_dev.spi_device = spi_device;
+ spike_dev.spi_device = spi;
spin_unlock_irqrestore(&spike_dev.spi_lock, flags);
return 0;
static int spike_remove(struct spi_device *spi_device)
{
unsigned long flags;
+printk(KERN_INFO "%s %s()\n", MODULE_NAME, __FUNCTION__);
+ // SPI受信タイムアウトタイマ停止
+ hrtimer_cancel(&spike_dev.timer);
+ // SpinLock
spin_lock_irqsave(&spike_dev.spi_lock, flags);
- spike_dev.spi_device = NULL;
+ spike_dev.spi_device = NULL;
spin_unlock_irqrestore(&spike_dev.spi_lock, flags);
return 0;
}
+// SPI Driver構造体初期化
+static struct spi_driver spike_driver = {
+ .driver = {
+ .name = this_driver_name,
+ .owner = THIS_MODULE,
+ },
+ .probe = spike_probe,
+ .remove = spike_remove,
+};
+//
+/**** spike_init()関係 *****************************************************
+ * モジュール初期化 load
+ * モジュール終了 unload
+ */
/*
SPIデバイスの設定
*/
printk(KERN_ALERT "Missing modprobe omap2_mcspi?\n");
return -1;
}
-
spi_device = spi_alloc_device(spi_master);
if (!spi_device) {
put_device(&spi_master->dev);
printk(KERN_ALERT "spi_alloc_device() failed\n");
return -1;
}
-
+ // 使用するCSx設定
spi_device->chip_select = SPI_BUS_CS0;
-
/* Check whether this SPI bus.cs is already claimed */
snprintf(buff, sizeof(buff), "%s.%u",
dev_name(&spi_device->master->dev),
spi_device->chip_select);
-
pdev = bus_find_device_by_name(spi_device->dev.bus, NULL, buff);
if (pdev) {
- /* We are not going to use this spi_device, so free it */
+ // デバイス取り除く
+ device_del(pdev);
+ }
+ spi_device->max_speed_hz = SPI_BUS_SPEED;
+ spi_device->mode = SPI_MODE_0;
+ spi_device->bits_per_word = 8;
+ spi_device->irq = -1;
+ spi_device->controller_state = NULL;
+ spi_device->controller_data = NULL;
+ strlcpy(spi_device->modalias, this_driver_name, SPI_NAME_SIZE);
+
+ status = spi_add_device(spi_device);
+ if (status < 0) {
spi_dev_put(spi_device);
-
- /*
- * There is already a device configured for this bus.cs
- * It is okay if it us, otherwise complain and fail.
- */
- if (pdev->driver && pdev->driver->name &&
- strcmp(this_driver_name, pdev->driver->name)) {
- printk(KERN_ALERT
- "Driver [%s] already registered for %s\n",
- pdev->driver->name, buff);
- status = -1;
- }
- } else {
- spi_device->max_speed_hz = SPI_BUS_SPEED;
- spi_device->mode = SPI_MODE_0;
- spi_device->bits_per_word = 8;
- spi_device->irq = -1;
- spi_device->controller_state = NULL;
- spi_device->controller_data = NULL;
- strlcpy(spi_device->modalias, this_driver_name, SPI_NAME_SIZE);
-
- status = spi_add_device(spi_device);
- if (status < 0) {
- spi_dev_put(spi_device);
- printk(KERN_ALERT "spi_add_device() failed: %d\n",
- status);
- }
+ printk(KERN_ALERT "spi_add_device() failed: %d\n",
+ status);
}
-
put_device(&spi_master->dev);
return status;
}
-static struct spi_driver spike_driver = {
- .driver = {
- .name = this_driver_name,
- .owner = THIS_MODULE,
- },
- .probe = spike_probe,
- .remove = __devexit_p(spike_remove),
-};
-
+/*
+ * spike_ctl初期化
+ */
static int __init spike_init_spi(void)
{
int error;
-
+
+ spike_ctl.busy = 0;
spike_ctl.tx_buff = kmalloc(SPI_BUFF_SIZE, GFP_KERNEL | GFP_DMA);
if (!spike_ctl.tx_buff) {
error = -ENOMEM;
error = -ENOMEM;
goto spike_init_error;
}
-
+// probe()関数などをspi driverに登録する
error = spi_register_driver(&spike_driver);
if (error < 0) {
printk(KERN_ALERT "spi_register_driver() failed %d\n", error);
goto spike_init_error;
}
-
+ // SPIデバイス設定
error = add_spike_device_to_bus();
if (error < 0) {
printk(KERN_ALERT "add_spike_to_bus() failed\n");
spi_unregister_driver(&spike_driver);
goto spike_init_error;
}
-// 一貫性のあるDMAマッピング
-/*
-spike_dev.spi_device->dev.coherent_dma_mask = 0xFFFFFFFF;
-
-spike_ctl.tx_buff = dma_alloc_coherent(&(spike_dev.spi_device->dev), SPI_BUFF_SIZE, &spike_ctl.tx_dma, GFP_ATOMIC);
- if (!spike_ctl.tx_buff) {
- error = -ENOMEM;
- goto spike_init_error;
- }
-
-// spike_ctl.rx_buff = kmalloc(SPI_BUFF_SIZE, GFP_KERNEL | GFP_DMA);
-spike_ctl.rx_buff = dma_alloc_coherent(&(spike_dev.spi_device->dev), SPI_BUFF_SIZE, &spike_ctl.rx_dma, GFP_ATOMIC);
- if (!spike_ctl.rx_buff) {
- error = -ENOMEM;
- goto spike_init_error;
- }
-*/
return 0;
spike_init_error:
-
if (spike_ctl.tx_buff) {
kfree(spike_ctl.tx_buff);
spike_ctl.tx_buff = 0;
-//dma_free_coherent(&(spike_dev.spi_device->dev), SPI_BUFF_SIZE, spike_ctl.tx_buff, spike_ctl.tx_dma);
-//spike_ctl.tx_dma = 0;
}
-
if (spike_ctl.rx_buff) {
kfree(spike_ctl.rx_buff);
spike_ctl.rx_buff = 0;
-//dma_free_coherent(&(spike_dev.spi_device->dev), SPI_BUFF_SIZE, spike_ctl.rx_buff, spike_ctl.rx_dma);
-//spike_ctl.rx_dma = 0;
}
-
return error;
}
-
-
+/*
+ * spike_dev.devt cdev初期化
+ */
static int __init spike_init_cdev(void)
{
int error;
- spike_dev.devt = MKDEV(0, 0);
+ spike_dev.devt = MKDEV(0, 0); // デバイス番号自動割り当て
error = alloc_chrdev_region(&spike_dev.devt, 0, 1, this_driver_name);
if (error < 0) {
return 0;
}
-
+/*
+ * spike_dev.class 初期化
+ * デバイスファイル/dev/spikeadX作る
+ */
static int __init spike_init_class(void)
{
spike_dev.class = class_create(THIS_MODULE, this_driver_name);
return 0;
}
-int spike_init_gpio(void)
+// GPIO関係初期化
+static int spike_init_gpio(void)
{
if (gpio_request(GPIO_DRDY_IN, "GPIO_DRDY_IN")) {
printk(KERN_ALERT "gpio_request(GPIO_DRDY_IN) failed\n");
goto init_gpio_fail_1;
}
-
if (gpio_direction_input(GPIO_DRDY_IN)) {
printk(KERN_ALERT "gpio_direction_input(GPIO_DRDY_IN) failed\n");
goto init_gpio_fail_2;
gpio_free(GPIO_DRDY_IN);
init_gpio_fail_1:
-
return -1;
}
void spike_free_gpio(void)
gpio_free(GPIO_TOGGLE_OUT);
#endif
}
-int spike_init_irq(void)
+// DRDY割り込み初期化
+static int spike_init_irq(void)
{
int result;
- spike_ctl.irq = OMAP_GPIO_IRQ(GPIO_DRDY_IN);
+// spike_ctl.irq = OMAP_GPIO_IRQ(GPIO_DRDY_IN);
+ spike_ctl.irq = gpio_to_irq(GPIO_DRDY_IN);
result = request_irq(spike_ctl.irq,
irq_handler,
IRQF_TRIGGER_FALLING,
- "spike",
+ MODULE_NAME,
&spike_ctl);
if (result < 0) {
return 0;
}
-void spike_free_irq(void)
+static void spike_free_irq(void)
{
free_irq(spike_ctl.irq, &spike_ctl);
}
-
+/*
+ * モジュール全体の初期化
+ */
static int __init spike_init(void)
{
+printk(KERN_INFO "%s %s\n", MODULE_NAME, __FUNCTION__);
memset(&spike_dev, 0, sizeof(spike_dev));
memset(&spike_ctl, 0, sizeof(spike_ctl));
- sema_init(&spike_dev.fop_sem, 1);
spin_lock_init(&spike_dev.spi_lock);
-
- sema_init(&spike_ctl.cmd_sem, 1);
+ sema_init(&spike_dev.fop_sem, 1); // spike_dev排他アクセス用セマフォ初期化
+ sema_init(&spike_ctl.cmd_sem, 1); // spike_ctl排他アクセス用セマフォ初期化
+ sema_init(&finfo.finfo_sem, 1); // finfo排他アクセス用セマフォ初期化
finfo.f_version = 0; // 未使用マーク
+
// リングバッファ初期化
ring_init();
- if (spike_init_cdev() < 0)
+ if (spike_init_cdev() < 0) {
+ printk(KERN_ALERT "call spike_init_cdev() FAILED\n");
goto fail_1;
+ }
- if (spike_init_class() < 0)
+//printk("call spike_init_class()\n");
+ if (spike_init_class() < 0) {
+ printk(KERN_ALERT "call spike_init_class() FAILED\n");
goto fail_2;
-
- if (spike_init_spi() < 0)
+ }
+ // spike_ctl初期化
+//printk("call spike_init_spi()\n");
+ if (spike_init_spi() < 0) {
+ printk(KERN_ALERT "call spike_init_spi() FAILED\n");
goto fail_3;
+ }
// DRDY GPIO144 Input config
- if (spike_init_gpio() < 0)
+//printk("call spike_init_gpio()\n");
+ if (spike_init_gpio() < 0) {
+ printk(KERN_ALERT "call spike_init_gpio() FAILED\n");
goto fail_4;
-#if 1
+ }
// DRDY GPIO144 Interrupt config
- if (spike_init_irq() < 0)
+//printk("call spike_init_irq()\n");
+ if (spike_init_irq() < 0) {
+ printk(KERN_ALERT "call spike_init_irq() FAILED\n");
goto fail_5;
-#endif
+ }
+ // SPI受信タイムアウト用タイマ
+ hrtimer_init(&spike_dev.timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
+ spike_dev.timer.function = spike_timer_callback;
printk(KERN_INFO "%s %s initialized\n", MODULE_NAME, VERSION);
return 0;
return -1;
}
module_init(spike_init);
-
+/*
+ * モジュール全体の終了処理
+ */
static void __exit spike_exit(void)
{
- spi_unregister_device(spike_dev.spi_device);
- spi_unregister_driver(&spike_driver);
+ // DRDY割り込みOFF
+ disable_irq(spike_ctl.irq);
+printk(KERN_INFO "%s %s()\n", MODULE_NAME, __FUNCTION__);
-#if 1
spike_free_irq();
-#endif
spike_free_gpio();
+ // 割り込みかからないようにしてからタスクレットkill
+ tasklet_kill(&spike_tasklet); // DRDY割り込み用
+ tasklet_kill(&spike_spi_completion_tasklet); // SPI受信完了用
+
+//printk(KERN_INFO "spi_unregister_device()\n");
+ spi_unregister_device(spike_dev.spi_device); // spike_remove()呼ばれる
+//printk(KERN_INFO "spi_unregister_driver()\n");
+ spi_unregister_driver(&spike_driver);
device_destroy(spike_dev.class, spike_dev.devt);
class_destroy(spike_dev.class);
if (spike_ctl.tx_buff)
kfree(spike_ctl.tx_buff);
-//dma_free_coherent(&(spike_dev.spi_device->dev), SPI_BUFF_SIZE, spike_ctl.tx_buff, spike_ctl.tx_dma);
if (spike_ctl.rx_buff)
kfree(spike_ctl.rx_buff);
-//dma_free_coherent(&(spike_dev.spi_device->dev), SPI_BUFF_SIZE, spike_ctl.rx_buff, spike_ctl.rx_dma);
if (spike_dev.user_buff)
kfree(spike_dev.user_buff);
MODULE_AUTHOR("Naoya Takamura");
MODULE_DESCRIPTION("sciLog AD SPI driver based on spike");
MODULE_LICENSE("GPL");
-MODULE_VERSION("1.0");
+MODULE_VERSION(VERSION);
OSDN Git Service
